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ABSTRACT 


This  thesis  is  a study  of  the  Omega  navigation  system  as 
currently  iaplemented  in  the  P~3C  aircraft.  The  possibility 
of  using  a microcomputer  to  solve  the  internal  processing 
functions  is  investigated.  Data  flow  graphs  were  applied  to 
the  velocity  and  navigation  processing  function  in  the  Omega 
system.  These  graphs  assisted  in  the  development  of  the 
PL/M  code  which  implements  the  function.  Tne  four  PL/M 
subroutines  that  were  written  can  compute  the  velocity  and 
navigation  equations  in  sufficient  time  and  witn  sufficient 
accuracy  to  encourage  additional  research  into  a 
microcomputer  implementation  of  tne  remaining  internal 
functions  of  the  Omega  system. 
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LiilSODUCTION 


This  thesis  examines  the  use  of  a microcomputer  to  solve 
the  internal  processing  functions  of  the  current  ?-3C  Update 
Omega  navigation  system.  Tne  most  important  reason  for 
studying  a microcomputer  for  the  Omega  navigation  system  is 
that  during  an  excessive  system  load  in  the  P-3C  aircraft, 
the  Omega  signal  processing  is  partially  inhibited. 
Operating  in  this  inhibited  mode  appeared  unnecessary  in  a 
sophisticated  system  such  as  the  P-3C  incorporates, 
especially  with  the  existing  technology  of  microprocessors 
and  distributed  systems  [Refs.  1,  2,  and  3].  With  a 
microcomputer  dedicated  to  Omega  navigation  processing,  this 
inhibited  mode  of  operation  could  be  eliminated  and  position 
updating  information  could  be  availaole  continuously . 

The  analysis  of  the  existing  velocity  and  navigation 
processing  routine  utilizes  the  current  equations  in  tne 
published  manual  on  the  P-3C  Update  system  functional 
description  for  Omega.  The  main  tool  for  the  analysis  is 
the  data  flow  graphs  of  the  existing  equations.  This  gives 
efficient  and  optimal  PL/M  code. 

Section  II  of  this  thesis  presents  fundamental 
information  applicable  to  the  worldwide  Omega  navigation 
system  and  the  AN/AHN-99(V)  receiver-converter.  Section  III 
introduces  the  various  internal  processing  functions  of  the 
system  and  presents  a data  flow  grapn  depicting  the 
parameters  which  apply  to  each  of  the  functions.  Section  IV 
presents  the  analysis  of  the  velocity  and  navigation 
processing  routine  with  applicable  data  flow  graphs. 
Section  V gives  the  conclusion  of  the  study. 


II. 


THEORY  OF  OMEGA  SYSTEM  OPERATION 


OMEGA  is  a worldwide,  very  low  frequer.cy  (VLF)  , radio 
navigation  system  which  utilizes  rhe  radiation  from  eignt 
transmitting  stations  to  provide  global  coverage  to 
aircraft,  ships,  land-vehicles,  and  submarines  for  accurate 
and  reliable  positioning.  Table  I lists  the  presently 
available  transmitting  stations  with  appropriate  latter 
designators,  coordinates,  and  direction  cosine  values  [Hef. 
4].  The  position  of  each  transmitting  station  is  shown  in 
Figure  1 . 

A.  SYSTEM  PRINCIPLES 

Each  of  the  eight  transmitting  stations  radiates 
continuous,  sinusoidal  wave  bursts  at  10.2  kHz,  13.6  xHz, 
and  11.3  kHz.  These  signals  are  phase  locked  and  time 
synchronized  to  Universal  Time  such  that  all  three  signals 
start  at  zero  value  with  positive  slope  at  0000  hours 
Greenwich  Mean  Time  (GMT)  and  repeat  at  ten  second  intervals 
[Ref.  5].  Figure  2 depicts  a standard  ten  second  interval 
transmission  pattern. 

In  order  to  understand  the  complexity  of  the  Omega 
navigation  system  and  the  operations  performed  by  the 
receiver  and  the  computer  software  functions,  a simplified 
view  of  the  systems  operation  is  presented  first.  Assume 
some  arbitrary  transmitting  station  is  radiating  on  one  of 
the  three  frequencies,  and,  at  some  distance  d,  a receiver 
is  acquiring  the  signal  for  future  processing.  The 
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STATION 


LOCATION 


LAT/LONG 


DIRECTION  COSINE 


A 

u.~ 

Norway 

660  25* 
(3°  8* 

12.39"  N 
12. o5"  E 

SA1  = +0.91551829 
SA2  = +0.39172334 
SA3  = +0.09  153733 

B 

Liberia 

60  18* 
1Q0  39' 

19.39"  N 
44.21"  W 

SB1  = +0.98221041 
SB2  = +0.98117517 
S33  = -0. 16588382 

C 

Ha  waii 

210  24* 
1570  491 

16.90"  N 
52.70"  W 

SCI  = +0.36233231 
SC2  = -0.36296869 
SC3  = -0.35  162108 

D 

N. Dakota 

460  2 1 ' 
980  20* 

57.20"  N 
08.77"  U 

SD1  = +0.72144222 
SD2  = -0. 10039077 
SD3  = -0.68515398 

E 

La  Reunion 

200  50. 

26.47"  S 

SE1  = -0.35585299 

Island 

550  17* 

24.25"  E 

552  = +0.53214875 

553  = +0.76823587 

F 

Argentina 

430  03* 
b5o  11* 

12.53"  S 
27.60"  W 

S?1  = -0.68022941 
SF2  = +0.30756230 
SF3  = -0.66535207 

G 

Trinidad 

100  42' 
610  33. 

06.20"  N 
20.30"  M 

SGI  = +0.1 8449565 
SG2  = +0 . 466871  16 
SG3  = -0.66486570 

H 

Japan 

340  46* 
1290  27* 

53.26"  N 
12.49"  E 

SHI  = +0.56547261 
SH2  = -0.52409936 
SK3  = +0.63683o39 

160*  |180 
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FIGURE  I - OMEGA  SYSTEM  TRANSMITTER  LOCATIONS 


STATION 


FIGURE  2 - OMEGA  SYSTEM  TRANSMISSION  PATTERN 


TRANS.IITTIMt; 

STATION 


▲ 

RECSIVER 


transait'ed  sigaai  appears  as  a standarl  sinusoidal  wave. 
Assuainq  no  attenuation  of  the  signal,  a perfect  waveguide 
loraed  oy  the  earth  and  the  ionosphere  for  tne  signal  to 
propagate  through,  no  interfering  carrier  or  noise  signal, 
and  the  transmission  traveling  at  the  speed  of  lignt,  the 
received  signal  would  appear  as  a sinusoidal  wave  but  offset 
at  the  receiver  in  time  t by  d/c,  the  time  necessary  fer  the 
signal  to  travel  distance  d at  the  velocity  of  lignt  c. 


F<t)  =ro  t<a  R (t)  =ro  o<t<i/c 

^ SIN  (tat)  taO  ^ SIN  to(t-d/c)  t>d/c 

However,  this  ideal  situation  is  rarely  achieved.  The 
propagated  signal  is  affected  dv  several  factors  described 
in  a surseguent  section.  Due  to  the  repetitive  nature  of 
sinusoidal  waves,  the  precise  numcer  of  wave  lengths  must  oe 
computed  between  the  transmitter  and  the  receiver.  Also, 
the  iDSoiute  time  t of  the  transmitter  must  be  known.  These 
variables  are  calculated  in  the  combinational  filter. 

Position  fixing  with  the  use  of  O^IEGA  signals  is 
accomplished  by  two  methods.  The  first  method  utilizes 
pnase  difference  information  between  stations  and  tne 
resultant  nyperoolic  lines  of  position.  The  second  metnod 
uses  circular  lines  of  position  obtained  by  measuring  phase 
with  respect  to  a stable  freguency  standard.  The  P-3C  Om^ga 


12 


ndvi-jdtion  systeji  uses  the  circular  lines  of  position  or 
rho-rho  aetncd  to  determine  position  fi/es. 

Of  priodry  iniportance  in  itiliring  tne  G.'ISGA  7L?  signals 
for  the  rho-rho  aethod  dre  the  ability  to  detect  and  oeasure 
the  pnase  of  d received  signal,  and  the  ability  to  predict 
the  phase  of  the  signal.  In  order  to  detect  and  measure  the 
phase  of  a received  signal  using  the  rho-rho  aetnod,  tne 
first  process  perforaed  in  the  Oaega  navigation  system  is  to 
relate  the  internal  clock.  of  the  computer  with  tne 
transmission  curst  pattern  of  the  stations.  Tnis 
synchronization  process  is  described  in  more  detail  in  a 
sdfcseguent  section.  The  overall  effect  aiiOi^s  tne  cojiouter 
program  to  know  what  station  and  frequency  is  being 
processed  at  any  internal  system  time  t.  If  ail  three 
frequencies  from  ail  eignt  stations  could  be  received  at  any 
point  on  the  earth's  surface,  the  ten  second  reception 
pattern  would  appear  as  in  Figure  3.  For  a more  realistic 
reception  pattern.  Figure  4 depicts  tne  three  closest 
transmitter  stations  to  Hawaii,  and  Figure  5 represents  tne 
signal  pattern  an  aircraft  would  receive  at  Hawaii. 

Once  sy ncnron izati on  is  completed,  the  Omega  navigation 
syste.m  ccmaences  to  process  the  received  signals  througn 
various  software  filters  ia  order  to  nea.sure  the  phase.  Tne 
filters  wnich  process  the  received  signal  are  coraposei  of 
three  burst  filters  (ie.  one  for  each  frequency)  and  2a 
tracKing  filters  (ie.  one  for  each  of  the  tnree  freguencies 
on  each  of  the  eight  stations).  The  primary  function  of  the 
burst  filters  is  to  calculate  the  phase  measurement  and  the 
pnase  variance  for  each  frequency  and  station  received  by 
the  receiver.  The  tracning  filter,  on  receiving  the  phase 
measurement  and  variance  of  the  phase  measurement  from  the 
burst  filter,  utilizes  these  values  to  acquire  a more 
accurate  estimate  of  phase  arid  phase  variance  over  several 
ten  second  time  intervals. 


1 3 
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GURE  4 - SPECIFIC  TRANSMITTER  LOCATIONS 


Thfe  tracking  filter  perforji^  two  differen*  updates  on 
the  burst  filter  data.  riie  first  update  is  a tine  update. 
This  update  rs  required  because  of  the  d ispiaceaent  of  the 
aircraft  receiver  between  successive  aeasureaents  of  the 
received  sijnai.  The  ti:ae  update  procedure  projects  the 
last  estimate  of  phase  through  tiae  so  tnat  at  reflects  the 
new  position  of  the  aircraft.  These  procedures  are  defined 
as  rate  aiding  and  are  dependent  on  velocity  sources 
external  to  tiie  Omega  system.  In  estimating  the  change  in 
position.  It  is  possible  to  estimate  what  the  change  snould 
be  for  a particular  station  and  frequency.  This  predicted 
pnase  change  is  then  added  to  the  last  estimate  or  phase  to 
create  a new  phase  estimate. 

|)T?.K(t;  = PTRK(t-1)  +[A^DF.  (t)  t-  A D£ER  (t- 1)  ] * A t 

where  A (t)  is  the  pnase  rata  wnicn  represents  tae 
average  rate  of  change  of  phase  along  the  arc  connecting  a 
station  and  the  aircraft,  and  A'J)EER(t-l)  is  the  estimate  of 
the  error  in  the  phase  rate  and  is  calculated  in  the 
measurement  update  section.  The  second  update  is  a 
measurement  update,  and  is  performed  every  time  the  burst 
filter  supplies  a measurement  of  phase  and  phase  variance  to 
tne  tracking  filter.  This  measurement  update  procedure 
combines  the  rate  aidi.ng  pnase  estimate  from  tne  tracking 
filter  with  the  curst  filter  phise  measurement  to  produce  a 
better  estimate  of  the  phase  based  on  tne  following 
equation . 

Ip  = (tJK  - 4>TRK  (t)  t [ A PDR  (t)  + A PEER  (t)  ] ♦ ( J . 42  5) 

wnere  p is  defined  to  be  the  angular  difference  of  phase. 
The  combinaticn  of  the  phase  measurement  from  the  burst 
filter  ana  the  phase  estimate  from  tne  tracsing  filter  is  a 
weighted  average,  wnere  t.ne  coefficients  are  computed  using 
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T 


the  phase  variance  from  the  burst  filter  (ct^iJjk)  ani  the 
phase  variance  rrom  tne  tracking  filter  (cr  2(J>xrk)  . 


4>TRK  (t) 


iDTRK(t-l)  + ARCTAN 


(cr  2(tTRK  S) 

( (a-  2iJ)JK  + 0-2  UTRK) 


where  S = SIN  and  C = COS  1). 


Once  the  measurement  of  phase  nas  been  calculated,  it  is 
supplied  to  tne  combinational  filter  for  processing  along 
with  a phase  estimate  calibrated  in  the  propagation 
prediction  procedure.  with  tne  measured  phase  and  the 
predicted  phase  availanie  for  fining,  the  last 
reguireaent  to  be  iaplemer.teJ  for  u-.iliration  of  tne  rno-rho 
tecnnigue  of  position  fixing  is  to  synchronize  tne  receiver 
oscillator  with  the  transmitter  oscillator.  This  is 
accomplished  in  the  combinational  filter  by  computing  tne 
time  difference  between  the  transmitting  station  phase  and 
the  receiver  oscillator  phase. 


^ Coverage 

Tne  VLF  signals  utilized  by  the  OMEGA  system  are 
transmitted  ever  extremely  long  distances  of  tne  earth's 
surface,  because  tney  are  propagated  through  a natural  wave 
guide  formed  by  the  surface  of  the  earth  and  the  ioncsenere. 
Due  to  tne  advantageous  properties  of  high  phase  stacility 
and  lew  attenuation  rates  of  VL?  signals,  no  modulation  of 
th“  signals  is  reguired  prior  to  trans mission . Because  these 
signals  are  unmodulated,  only  their  relative  position  in  any 
ten  second  time  interval  enables  receivers  to  iieatify  the 
station  being  received.  Dt  primary  importance  in  utilizing 
the  OMEGA  VLF  signals  are  the  ability  to  letect  and  measure 
the  pnase  of  a received  signal,  and  the  ability  to  predict 
the  phase  of  the  signal.  Geverai  factors  have  an  effect  on 


th-5  propagation  of  VLF  oignalo  anl  consaguent ly  the  aciiity 
or  an  airborne  0;iiega  systea  to  receive  and  procejs  the 
signals  ter  accurate  positioning  [5ef.  6].  These  factors 
are  described  in  the  section  pertaining  to  propagation 
predict icn. 

Receiver-Converter 

The  AN/AP.  :i-49  receiver  vas  developed  by  tne 
Electronics  Division  of  tne  Northrop  Corporation  in 
Hawthrone,  California.  It  was  designed  for  operation  with 
all  eight  t ransaittin g stations  and  to  provide  a continuous 
update  of  aircraft  position.  The  receiver- con  ver :er 
installed  in  the  P-3C  consists  of  several  aodular  asseTiolies 
as  shown  in  Figure  6.  The  antenna,  coaposed  of  two  loop 
antennas  fixed  at  right  angles  to  each  other  and  mounted  at 
45°  angles  to  the  aircraft  center  line,  is  controlled  cy  the 
burst  filter  function  in  the  computer  througn  the  antenna 
switching  matrix.  Tne  three  heterodyne  receivers  have  S? 
and  IF  sections  for  processing  or  the  input  signals.  The 
reguirements  for  filtering  the  received  signals  in  these 
sections  are  very  stringent.  The  filtering  in  tne  RF 
section  removes  the  RF  image,  including  all  freguencies  in 
the  area  of  the  harmonics  of  the  local  oscillator.  The 
narrow  band  filtering  in  the  IF  section  provides  for  the 
rejection  of  interfering  carriers.  In  addition,  limiters 
are  used  for  controlling  the  dynamic  signal  levels,  and  a 
bandpass  filter  is  used  to  remove  the  harmonics  created  by 
the  previous  limiters.  The  resultant  output  of  the  SF  and 
IF  filtering  sections  leaves  the  fundamental  freiuency  as  a 
sinusoid.  This  output  is  fed  into  a sine  and  cosine 
correlator  which  utilizes  a sguare  reference  signal  to 
produce  an  output  of  two  direct  current  signals.  One  dc 
signal  is  proportional  to  the  sine  of  the  burst  phase,  and 
the  other  dc  signal  is  proportional  to  the  cosine  of  the 


buLst  phase.  These  dc  signals,  which  represent  the  aeasured 
phaS'^  shift,  enter  the  analog  to  iigitai  converter  and  are 
transaittei  to  the  coaputer  section  tnrougn  the 
r ecei ver-con verter/co ap’ater  interface  box.  The  precision 
frequency  generator  provides  for  the  reference  signals  and 
test  signals  necessary  in  tne  aeasuring  of  the  pnase 
difference  of  the  receiver  signal  [Pefs.  7,  3]. 
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II  I. 


INTERNAL  PROCESSING  EUNCTIOtlS 


rhf?  navigation  systaa  in  the  ?-3C  aircraft  is  one 
of  five  navigation  sabsysteas  wnich  conprise  the  avioni.es 
navigation  systea.  The  remaining  subs/ste.-ns,  in  their 


priority 

of 

use,  are  a primary 

inertial,  a seconda 

- y 

inertial , 

a 

doppler  radar,  and  an 

air  data  computer.  I 

ae 

selectio  n 

an  d 

utilization  of  each  subsysre.m  is  dependent 

or 

tne  control  of  tne  Navigator/Coaaunicator  anl  on  tne 
availability  of  the  suosystea.  X bloc.h  diagraa  of  tne 
navigation  sucsyste.os  is  shown  in  Figure  7. 


A.  OJ!EGA  PHCCES3ING 


The  internal  processing  functions  of  tne  Oaeja 
navigation  system  are  snown  in  Figure  3 [Ref.  4].  A more 
detailed  description  of  tae  internal  processing  functions  is 
presented  in  Figure  9 showing  the  pertinent  data  transferred 
between  the  functions. 


^ • Initializa  tion 


Initialization  of  the  Omega  navigation  system  begins 
with  the  insertion  of  the  date  and  time  entries  by  tne 
I'lavigator/Coamunicdtor  and  suoseguent  activation  of  the 
initial  on  top  condition  or  aarh  aircraft  position.  Tne 
date  and  time  entries  are  usei  within  the  propagation 
prediction  module  to  calculate  an  estimate  of  the  phase 
value  derived  from  current  aircraft  position  at  the  moment 
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SYSTEM 


FIGURE  7 - NAVIGATION  SYSTEM  BLOCK  DIAGRAM 


FIGURE  8 - 


INTERNAL  OMEGA  PROCESSING  FUNCTIONS 
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FIGURE  9 - DATA  FLOW  GRAPH  OF  INTERNAL  FUNCTIONS 


of  initialization.  These  phase  values  are  use*]  to 
initialize  the  tracking  filters.  The  vaLianc--  values  within 
the  comb  inational  filter  are  also  initialized  at  this  time, 
and  the  position  matrix  R,  utilized  in  the  velocity  and 
navigation  prcressing  function,  is  initialized  based  un 
current  aircraft  latitude  and  longitude. 


2*  Test  ing 


hardware  testing  begins  immediately  after  the 
termination  of  tne  initialization  function,  and  also  after 
each  restart.  The  main  objective  of  the  hardware  testing 
module  is  to  determine  the  status  of  t.ne  Omega 
recei ver/ccnverter . Additionally,  hardware  testing  provides 
a method  or  assuring  proper  operation  of  ail  Onega 
eguipaent.  The  testing  involves  a series  of  subtes*-.s  wnich 
validates  the  operation  of  the  input/output  interface 
oetween  tne  receiver/con v erter  and  tne  computer.  The 
subtests,  which  are  described  in  greater  detail  in  Ref.  4, 
are  a ccmnunication  suctest,  a co.nerence  status  siotest,  an 
Omega  output  suotest,  an  Omega  input  subtest,  a pnase  angle 
to  digiral  subtest,  a phase  counter  suotest,  and  a RF/IF 
sjbtest.  An  oscillator  drift  subtesr,  which  is  classified 
as  a hardware  test,  is  nor  implemented  until  single 
freguency  processing  commences  in  the  combinational  filter 
routine . 

3*  Synchronization 


Synchronization  of  the  Omega  navigation  system  to 
tne  Omega  tr ansaission  pattern  is  the  most  critical  function 
executed  oy  tne  navigation  system.  3y  aligni.ug  itself  wizh 
the  ten  second  interval  transmission  pattern,  t.ie  Omega 
navigation  set  processes  the  correct  VLF  signal  bursts  in 


w 
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subsei^uent  routines.  Synchronization  is  acco:np  1 rsh  e i ay 
utiiizinj  the  variable  length  transmission  tine  intervals  of 
the  viricus  frequencies  and  a differential  correlation 
technique.  The  first  assumption  cade  in  the  routine  is 
that  all  eiqnt  stations  tnat  are  presently  in  operation  are 
operating  or.  all  three  frequencies.  The  routine,  starting 
at  some  raadcm  time,  accepts  from  the  r 2cei ver-con ver ter  a 
ten  second  interval  of  data  composed  of  100  suit  a;id  1 jO 
cosine  values  over  contiguous  100  millisecond  intervals. 
One  hundred  correlation  coefficients  are  calculated  for  the 
freguency  under  consideration  utilizing  the  difference 
between  short  sum  and  long  sum  intervals  and  adding  tnese 
differences  over  the  eight  count  nurst  pattern.  Figure  10 
dapicts  the  short  sum  and  long  sum  i.ntervals  over  a ten 
second  interval  pattern,  and  the  limits  of  the  short  and 
long  sums.  The  correiation  coefficirrnt  formula  is  given 
below  . 


8 

C(I|-2 

J=1 

(1= 1, 100) 


2 

I \ 

2 

I X(S) 

■f  1 

f \ 1 

■f 

^K=I  + JL  j 

J 'J— o L + 1 J U - J 


JU  + 

I 


■i  (.M 


\K=ItJL-2 


The  values  X (K)  and  Y (.K)  are  the  sin<-  and  cosine  values 
respectively  received  from  t ne  receiver-converter.  Fac.!  of 
tne  confidence  coefficients  ca.n  be  considered  to  be  a 
measurement  of  how  well  the  received  ten  second  burst 
pattern  matches  the  transmitted  burst  pattern.  The  higher 
tne  coefficient  value,  the  greater  confidence  is  associated 
to  the  index  numher  I being  the  starting  point  of  tne 
transmitted  burst  pattern  within  ± 50  milliseconds.  The 
four  largest  confidence  coefficients  are  saved  in  descending 
order  of  magnitude,  along  with  their  respective  index  .number 
I.  This  index  number  is  used  in  determining  the  starting 
point  of  tne  ten  second  burst  patter.a.  Various  conditions 
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to  the  four  highest  confidence  coefricients  and 
index  nuoiers  are  tested  in  oraer  to  determine  the  success 
or  the  failure  of  the  s ynchroniratioa  attempt.  If  the 
current  confidence  level  fails,  the  next  sequential 
frejuency  is  utilized  to  acquire  the  next  ten  second 
interval  cf  data.  Tne  synchronization  routine  continues  in 
this  mode  until  a successful  synchronization  occurs  or  until 
the  Navigator/Coam  unicator  interv-^nes. 
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SHORT 


SYNCHRONIZATION  PARAMETERS 


Eur^t  Filt-er 


4 . 


The  burst  filter  routine  commences  upon  successful 
coupietion  of  sy  nchr  o nira  tior. . Tnis  routine  calculates  the 
pnasc  Jieasureaents  and  tna  variance  of  tnese  pnase 
aeasure.Tients  for  eaca  station  and  freipuency  received  by  tae 
Oaega  navigation  set.  It  also  selects  the  optical  antenna 
inputs  and  test  data  for  tne  Omega  receiver,  .-naintains 
synchronization  with  the  transmitted  burst  pattern,  and 
ccaputes  the  phase  aeasurement  and  its  confidence 
measurement  oased  on  the  receiver  phase  difference  and  test 
data  from  the  receiver.  The  eguations  are: 


>i)JK  = AECTAIJ 


(XbJK)”]  - DOK  t $ 
( YbJK) 


cr  2 J s = 


G 


0t.< 


A t J 


(AtJ  - QJK)  L 

(QJ.K  - ^tK)J 


(0 . 005)  * (2rr)  ]2 


wnere  ip  • is  a phase  correction  (0°  or  150*^)  .added 


received  signal  to  account 

for 

error  i 

n reception  , 

tne  phase 

angle  offset 

for 

f regue 

ncy  K computed 

Calibration 

measu  remenr , 

and 

adJ.< 

and  YnJK  are 

measurement 

suns  corrected 

for 

pr.a  nt  oid 

error. 

to  tne 
J)C:<  is 
in  t ne 
burst 


To  accomplisn  these  calculations,  eacn  of  tne  eight 
bursts  and  associated  slots  are  divided  into  intervals  of 
time  as  shown  in  Figure  11.  The  start  burst  and  end  burst 
intervals  are  periods  of  time  where  the  sine  and  cosine  data 
are  not  used.  These  intervals  are  considered  transient 
periods  cr  waiting  periods.  During  the  burst  interval,  the 
sine  and  cosine  values  received  are  used  in  the  calculation 
of  the  phase  mea  sureinent  and  variance  of  the  onase 
measurement.  In  the  test  interval,  various  measurements 
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art  coafuttd  to  improve  the  accuracy  of  the  phase 
measurement,  and  ror  the  issuin-j  of  antenna  selection  and 
test  selection  comaands.  Reference  4,  pages  do  to  191, 
describes  in  detail  tne  coa puta tions  involved  in  calculating 
the  phase  ir.d  the  phase  variance  for  eacn  station  and 
fteguency  used  oy  the  Oaeji  navigation  system. 
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FIGURE  II  - BURST  FILTER  TIME  INTERVAL 


5-  Filters 


Once  the  burst  filter  processing  has  acquirei  a 
phase  aeasurement  and  an  estimate  of  the  variance  of  the 
phase  measurement  for  a specific  station  and  frequency, 
these  values  are  used  as  inputs  to  only  one  of  the  24 
traclting  filters.  Each  filter  is  similar  in  the  processing 
of  the  data,  tut  each  is  different  in  its  computational 
constants  for  the  various  frequencies  and  stations.  A 
simplified  description  of  a tracking  filter  is  that  it  is 
utilized  tc  acquire  a better  estimate  of  the  phase 
measurement  by  averaging  the  outputs  of  the  burst  filter 
over  successive  ten  second  intervals.  The  tracKing  filter 
routine,  using  the  measured  phase  from  the  burst  filter  and 
an  updated  estimate  or  phase  based  upon  previous 
measurements  and  dead  reckoning  information,  comoines  the 
measured  and  estimated  phase  and  utilizes  a weighted  average 
to  compute  a new  phase  estimate  and  phase  variance  estimate. 
Also  computed  witnin  the  tracking  filter  is  tne  variance  of 
the  estimate  of  the  error  in  the  phase  rate  of  change  iue  to 
aircraft  displacement  in  time.  Once  these  three  values  are 
computed  for  a particular  station  anl  frequency,  a test  is 
made  to  determine  the  accuracy  of  the  phase  measurement.  If 
the  variance  of  the  phase  measurement  is  less  than  or  equal 
to  (0.06  rr  radians)  2,  the  phase  measurement  is  considered 
accurate  enough  for  computations  within  the  combinational 
filter.  After  three  successive  measurements  and  successful 
tests,  a flag  is  set  indicating  that  the  data  is  valid  and 
availaole,  and  the  combinational  filter  reads  the  outputs 
frcm  the  tracking  filter.  Once  the  outputs  have  oeen  read, 
tne  count  of  successive  measurements  is  reset  to  zero,  the 
variances  of  the  phase  measurements  are  set  to  the 
initialization  values,  and  tne  data  valid  and  available  flag 
is  cleared.  If  at  any  time  in  the  tracking  filter  the 
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variance  cf  the  phase  measurement  exceeds  {O.Oorr  radians)  2, 
the  count  of  the  successive  measurements  is  reset  to  zero, 
and  the  data  valid  and  available  flag  is  cleared. 

The  input  values  to  the  combinat ional  filter  from 
the  tracking  filter  are  the  refined  estimates  of  phase 
measurement,  <DTRK,  phase  variance,  cr^<J)T'RK,  and  phase  rate 
variance,  a~  ^^E2E.  The  inputs  from  the  propagation 
prediction  routine  are  the  estimates  of  phase,  $PROP, 
improved  for  propagation  effects  and  phase  variance, 
o-2(J)prop.  Within  the  combinational  filter  routine,  these 
input  values  are  statistically  combined  to  provide  the  best 
estimates  of  system  position  and  velocity.  The 
combinaticnal  filter  routine  provides  for  the  conversion 
from  phase  tc  geodetic  coordinates  (latitude  and  longitude)  , 
and  also  determines  the  phase  and  frequency  differences 
between  the  receiver  oscillator  and  the  transmitted  OMEGA 
signal.  Cnee  the  Omega  receiver  oscillator  is  calibrated, 
the  Omega  navigation  system  operates  when  only  two 
transmitting  stations  are  accessible.  In  addition,  the 
combinaticnal  filter  is  used  for  lane  determination  through 
the  teennique  of  multiple  state  vectors. 

a.  Description 

The  combinational  filter  is  a Kalman  filter. 
Reference  4 describes  the  Kalman  filter  technique  to 
filtering  and  prediction  as  a linear,  recursive,  minimum 
variance  filter.  R.  G.  Brown  and  L.  L.  Hagerman  [Ref.  9] 
describe  a Kalman  filter  as  simply  a means  of  estimating  the 
various  states  of  a random  process  from  a set  of  discrete 
measurements  having  a )cnown  linear  connection  to  these 
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states.  It  -was  further  noted  in  Ref.  10,  tnat  a Kalian 
filter  operates  only  on  the  systei  errors  and  not  on  total 
'juantities  such  as  position  and  velocity.  The  basic  concepts 
involved  are  rhose  of  state,  state  transition,  leasureraent , 
and  optimal  weighting  [Ref.  11].  The  states  of  the 
combinational  filter  are  differentials  of  system  variables 
[ie.  error  in  position  ani  Sj)3)  , oscillator  start  time 
(to)  , rate  of  change  in  oscillator  start  time  ( to  ) , and 
error  in  velocity  (Svc2  and  Svc3)  ].  The  following  chart 
describes  the  elements  of  the  state  vector  X [o  x 1]. 


ELEMENT  SYMBOLS 

1 S(t2 

2 S<13 

3 to 

to 

5 Svc2 

6 SVC3 


MEANING 

Position  error  along  tne  -32  direction  of 
the  system  position  matrix  R. 

Position  error  along  the  -R3  direction  of 
the  system  position  matrix  R. 

Time  difference  between  the  transmitting 
station  phase  and  the  receiver  oscillator 
phase. 

Time  rate  of  cnange  of  tg  . 

Error  in  the  east  component  of  velocity 
which  is  error  along  the  R2  direction  of 
the  system  position  matrix  R. 

Error  in  the  north  component  of  velocity 
which  is  error  along  the  R3  direction  of 
the  system  position  matrix  R. 


The  state  of  the  system  is  described  by  tne 
solution  of  linear  vector  differential  equations  depicting 
system  error  growth.  The  Kalman  filter  method  linearly 
combines  the  previous  estimate  of  the  state  vector,  X,  with 
a measurement  to  approach  a minimum  variance  estimation. 
This  minimum  variance  estimate  is  then  time  updated  until 
the  following  measurement.  The  measurement  calculation  is 
explained  by  the  following  equations. 
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Y = <)rRK  - ifPROP 


where  Y is  the  difference  between  the  tracking  filter  phase 
measurement  and  the  propagation  prediction  phase  estimate  of 
the  phase  measurement. 

Residual  = Y - H*X(t-l) 


where 


Residual 


(RES) 


is  the  difference  between  the 


calculated  error  in  the  measurement,  Y,  and  the  system 
estimate  of  the  error,  H*X(t-1)  . The  state  vector  X(t-l)  is 
ttie  previous  estimate  of  the  state  vector,  and  d [ 1 x 6j  is 
the  measurement  matrix  described  below. 


ELEMENT 


EQUATIONS 


MEANING 


EMER  ♦ 


R2J*SIJ  EMER  is  the  earths  mean  equa- 
torial radius  = 20925741.47  ft 


K ♦ SIN(DD)  R2J  and  R3J  are  the  elements  of 
the  r2  and  R3  vectors  of  the 
3 position  matrix  R. 

EMER  * ^ H3J*SIJ  SIJ's  (I  = A,B,..,H)  are  the 
J=  1 elements  of  the  station 

K * SIN((I)D)  direction  cosine  values. 

VL  VL  is  the  average  propagation 

AK  velocity,  and  AK  (K=1,2,3)  is 

the  wave  lengths  of  the 
frequencies  10.28,11.3,  13.6kHz 


where  <t»D  = ARCCOS  ( ^ R 1 J*SI J)  and  the  remaining  elements  of 


H are  zero.  New,  minimum  variance,  state  vectors  are 
produced  by  using  the  following  equations. 
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Xnew  = XoLd  b ♦ (R3S) 


uhere  b [6  x 1 ] is  the  optimal  weighting  vector  matrix. 

This  cptimal  weighting  vector,  b,  is  estanlished 
by  means  of  time  propagation  of  system  error  growth  in 
combination  with  information  contained  within  the 
measurement.  The  weighting  is  a function  of  the  covariance 
matrix,  P [6  x 6 ],  of  the  difference  between  system  error 
state  vector,  X,  and  the  average  state  vector  Xavg. 

P = 2 • [ (X  - Xavg)  * (X  - Xavg)^  ] 

where  2 is  the  expected  value  of  the  difference  between  the 
value  of  the  difference  between  tne  value  for  tne  real  state 
vector  X,  if  all  conditions  were  icnown,  and  the  average 
state  vector,  Xavg.  The  following  cnart  describes  the 
elements  of  the  covariance  matrix  P. 


ELEMENT 

SYMECLS 

MEANING 

PI  1 

O'  2(t2 

The  position  variance  for  the  position 
error,  &<t>2 , along  the  -P.2  direction 

F22 

o-  2(53 

The  position  variance  for  the  position 
error,  S't>3 , along  the  -R3  direction 

P33 

O'  2 to 

The  variance  of  oscillator  phase  offset 

P4U 

o 

b 

The  variance  of  oscillator  drift  rate 

?55 

<T  2VC2 

The  variance  of  the  error  in  the  east 
component  of  velocity  5vC2 

P66 

<r  2VC3 

The  variance  or  the  error  in  the  north 
component  of  velocity  5vC3 

All  remaining  elements  of  the  covariance  matrix  are  zero. 

The  combinational  filter  effectively  computes 
optimal  estimates  of  position  and  velocity  along  with  the 
remaining  elements  of  a state  vector.  The  filter  uses  an 
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observation  cf  the  difference  between  the  phase  of  the 
tracking  filter  and  a value  of  the  phase  foriauiated  on  the 
time  updated  position  of  the  combinational  filter.  Based  on 
tnis  measurement,  the  combinational  filter  derives  estimates 
of  position  errors,  velocity  errors,  oscillator  start  time 
and  oscillator  drift. 

Because  the  Omega  navigation  system  functions 
with  several  distinct  velocity  sensors  (ie.  inertial, 
doppler,  or  air  data),  a different  mode  of  operation  exists 
for  the  combinational  filter  for  each  sensor.  Each  metnod 
requires  tne  filter  to  estimate,  predict,  and  control  a 
different  set  of  system  errors.  Each  set  of  system  errors 
conforms  to  the  dead  reckoning  velocity  source  used  for  time 
updating . 


The  combination  of  uncertainties  in  position 
error  and  receiver  oscillator  start  time  produces  a 
vagueness  of  the  number  of  wave  lengths  or  lanes  between  the 
transmitting  station  and  the  receiver.  This  ambiguity  occurs 
primarily  when  the  system  is  first  irritialized.  To  find  the 
solution  to  this  lane  ambiguity,  several  estimates  of  the 
state  vector,  X(i)  's,  are  calculated  by  the  filter.  These 
X(i)'s  correspond  to  the  different  possible  lanes  or 
integral  values  of  phase  measurement.  As  measurements  are 
acquired,  corresponding  to  the  three  frequencies,  the 
uncertainity  in  oscillator  start  time,  to,  is  diminished. 
Measurements  from  different  stations  tend  to  minimize  the 
position  uncertainity.  -.he  general  effect  is  a reduction  in 
th*i  number  of  state  vector  estimates,  X(i)'s,  that  can  be 
considered  logical  estimates  of  the  most  accurate  state 
vector  until  only  one  credible  estimate  remains.  The 
criterion  for  reasonableness  is  based  on  variance 
considerations. 
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D.  Operation 


There  are  three  aistinct  operations  identified 
with  the  coBtinational  filter  routine. 

1)  Initialization 

2)  Time  update 

3)  Measurement  update 


The  initialization  operation  assigns  the  initial 
values  of  variance  to  the  oovariance  matrix  ?,  sets  the 
elements  cf  the  initial  state  vector  to  zero,  and  sets  tae 
system  driving  noises  as  a function  of  the  velocity  source. 


In  toe  time  update 
vector  X,  and  the  covariance 
the  last  update.  The  following 
the  time  update  operation. 


operation,  both  the  state 
matrix  P,  are  predicted  from 
eguations  are  utilized  in 


Xnew  = $new  * Xold 

Fnew  = Jnew  * Poll  * ^new^t  ,Vr.ew 


Tne  transition  matrix  [ 6 x 6]  ma  theaatical  ly  expresses  the 
propagation  of  errors  across  the  time  interval  A t since  the 
last  update.  The  elements  of  the  transition  matrix  are 
shewn  in  the  following  chart. 
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where  ^i  (i  = I,D,  or  A)  signifies 


the  inverse 


corre  lation 
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time  of  5vC2  and  SvC3  for  tne  velocity  source  mode  utilized. 
The  transition  matrix  $ furnishes  the  prepay ation  of  the 
predicted  elements  of  the  state  vector  X and  the  covariance 
matrix  P across  the  time  interval  At.  The  variance  effects 
across  this  time  interval  are  propagated  by  the  additive 
diagonal  noise  matrix  N [6  x 6].  The  following  chart  depicts 
the  elements  of  tne  noise  matrix  N. 
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where  ^i  is  the  inverse  correlation  time  described 
previously,  and  cr  ^i  is  the  variance  of  the  velocity  errors 
(6vc2  and  5vc3)  and  is  dependent  on  velocity  source  utilized 
(i=I,D,  or  A). 


During  the  time  update  operation,  the  multiple 
state  vectors,  X (i) ' s,  which  exist  until  the  correct  lane 
has  been  determined  must  also  be  time  updated.  The  time 
update  equation  for  the  state  vector  X must  be  sequenced 
through  all  state  vectors. 

X (i)  new  = ^new  * X (i)  old  for  all  i 

The  covariance  matrix  time  update  equation  is  computed  once, 
because  there  is  only  one  covariance  matrix  regardless  of 
the  number  of  state  vectors. 

After  completion  of  the  time  update  operation 
tc  the  measurement  update  operation,  the 
residual,  (RES),  measurement  matrix,  ti , and  the 
confidence  scalar,  C,  are  calculated  for  each 


and  prior 
aea  sureoent 
measurement 
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tracking  filter  input.  The  neasureoient  residual  and 
neasurement  matrix  calculations  were  previously  explained  in 
the  section  describing  the  combinational  filter.  The 
measurement  confidence  scalar,  C,  is  a measurement  of  noise 
computed  by  the  following  eguation. 

C = cr  2^PR0P  + a-  2(J)TRK 

where  c ^(tiPhOP  and  cr  20xRK  are  the  variance  of 
the  propagation  prediction  phase  estimate  and  the  tracking 
filter  phase  measurement. 

The  measurement  update  operation  involves  the 
generation  of  a linear,  unbiased  weighting  vector  b,  and 
computation  of  a new,  minimum  variance,  state  vector  X by 
the  formula  listed  below. 

Xnew  = Xold  + b * (RES) 

To  generate  the  optimum  weighting  vector,  b,  three 
expressions  are  required. 

1)  the  predicted  measurement  variance  - 

2)  the  measurement  confidence  scalar  - C 

3)  the  divergence  control  factor  - e (epsilon) 

The  weighting  vector  is  calculated  from  the  following 
equations. 

Q = M*P*M^  + C 
b = (P»M^  ♦ eM^)  / Q 

where  Q is  defined  to  be  a scalar  quantity  depicting  the 
lane  variance,  and  C is  a factor  to  prevent  divergence  of 
the  estimation  process.  Also  updated  in  the  measurement 
update  process  is  the  covariance  matrix  based  on  the 
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foliowinj  fornmid. 

Fnew  = Fold  - b * M * Fold  e * » b^ 

Th€  retention  of  new  state  vectors  is  predicated  on  the 
testin>^  cf  the  position  elements  in  the  state  vector,  and 
tne  variance  values  in  the  covariance  matrix. 

Propagation  Predict  ion 

In  order  to  effectively  resolve  tne  aircraft 
position  from  the  phase  information  received,  the  pr.ase 
velocity  cf  the  wave  along  the  propagated  path  and  tne 
length  of  the  path  must  be  known.  Several  factors  or 
effects  create  imperfectio ns  in  tne  wave  guide  througn  wnich 
the  VLF  signals  propagate.  The  propagation  prediction 
function  establishes  the  best  estimate  of  phase  and  phase 
variance  taking  into  account  tne  factors  listed  below  which 
effect  the  phase  velocity  of  the  propagated  signals. 

a.  Diurnal  Effects 

The  positional  changes  of  the  sun  over  the  earth 
adjust  the  size  and  the  shape  of  the  ionosphere.  The  change 
of  the  wave  guide  through  which  the  VLF  signals  propagate 
causes  a change  in  the  velocities  of  the  phase  signal  which 
results  in  a difference  in  phase  angle  received  at  the  Omega 
receiver  location. 

D.  Ground  Conductivity 

This  factor  takes  into  account  the  effect  of 
various  meaiums  over  wnich  VLF  signals  travel.  Water,  which 
is  a neat  perfect  conductor  of  VLF  signals,  does  not  greatly 
affect  the  signals.  Land,  which  is  a less  perfect  conductor 
of  VLF  signals,  does  affect  the  signals  to  a greater  extent. 


w 
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Conductivity  fdtterns  have  been  neasured  and  are  predictable 
[ Ref . 6 ] . 


c.  Earth's  Magnetic  Field 

This  factor  affects  both  the  attenuation  rate 
and  the  velocity  of  the  signal.  The  phase  shift  on 
refraction  of  the  VLF  signal  off  of  the  ionosphere  depends 
on  the  interaction  of  the  signal  with  the  electrons,  and 
this  depends  on  the  orientation  of  the  aagnetic  field  with 
respect  to  the  direction  of  propagation  and  on  the  Magnitude 
of  the  field  [Ref.  12]. 

d.  Latitude  and  Spheroidal  Effects 

This  factor  takes  into  account  the  nonspherical 
shape  of  the  earth  and  the  adjusted  path  of  travel  from  rhe 
transmitting  station  to  the  Omega  receiver. 

e.  Folar  Cap  Absorption  (PCA) 

VLF  signals  which  pass  over  the  Polar  Cap 
experience  an  abnormal  rate  of  absorption  during  both  day 
and  night.  PCA  produces  large  changes  in  VLF  signal  patterns 
which  can  last  for  several  days. 

f.  Sudden  Ionospheric  Disturbance  (SID) 

Sclar  flares  emanating  on  the  sun's  surface 
increase  the  ionization  within  the  atmosphere.  These  SID's 
cause  large  changes  in  the  phase  of  VLF  signals  passing 
through  the  area  of  activity. 

Of  the  six  factors  which  affect  the  propagation  of 
VLF  signals,  the  first  four  are  predictable  and  can  be 
coapensated  for  algorithmically,  while  the  last  twc  are 
unpredictable  and  cannot  be  compensated  for  within  an  Omega 
navigation  system. 


IV. 


V^OCITY  and  NAVIGATI^  ?50C253I!iG  FG^ICIION 


The  velocity  and  navigation  processing  function  is 
divided  into  two  routines  in  the  Oaiega  navigation  syste:n. 
The  velocity  processing  routine,  utilizing  tne  current 
navigational  source  (ie.  inertial,  doppler,  or  air  data), 
calculates  the  velocities  along  ti.e  systea  axes  frca  the 
available  source  velocities.  These  systea  axes  velocities, 
ccabined  jith  the  state  vector  corrections  froa  the 
coabinat  icna 1 filter,  are  supplied  to  the  navigation  routine 
in  order  to  update  the  Oaega  systea  position  natrix  and  the 
Omega  aircraft  latitude  and  longitude  position. 


A.  VELOCITY  PROCESSING 


In  the  velocity  processing  routine,  the  aircraft  current 
true  airspeed  velocity  (VTAS)  and  heading  (ACHDG)  , the 
current  wind  direction  (WD)  and  velocity  (VW)  , and  the 
dopplers  current  velocity  components  along  heading  (VDA)  and 
across  heading  (VDC)  are  utilized  to  compute  the  velocities 
in  the  North/South  and  Sast/West  directions  from  the 
following  equations. 


VCN  = 

VDA  ♦ 

COS (ACHDG) 

- VDC  * SIN  (ACHDG) 

VDE  = 

VDC  * 

COS  (ACHDG) 

+ VDA  * SIN  (ACHDG) 

VAN  = 

VTAS* 

COS  (ACHDG) 

e VW  * COS(WD) 

VAE  = 

VTAS* 

SIN  (ACHDG) 

+ VW  * SIN  (HD) 

where  VDN  and  VDE  signify  doppler  velocities  Nortn/South  and 
East/West,  and  VAN  and  VAS  signify  air  data  velocities 
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North/So'Jth  and  East/West  respectively.  In  constricting  the 
data  flcu  graph  of  tuese  eguations,  it  was  self-evident  that 
soaie  variables  could  oe  calculated,  stored  in  aeaory,  and 
retrieved  from  memory  wnen  they  were  repaired  in  later 
calculations.  Figure  12  depicts  the  data  flow  graph  for  the 
North/South  and  East/West  computations.  Implementing  PL/J*. 
code  directly  frcm  this  data  flow  graph  was  straight 
f or  ward . 

On  completion  of  the  North/South  and  East/West 
velocities  computations,  a test  is  made  in  the  velocity 
processing  function  to  determine  if  the  navigation  mode  has 
changed  since  the  last  iteration  of  the  velocity  function. 
If  an  upgrade  of  the  navigation  node  has  occurred  (ie. 
doppler  to  inertial,  or  air  data  to  doppler  or  inertial), 
then  the  summations  (DELVC2  and  DEI.VC3)  of  the  corrections 
to  the  system  velocity  components  from  the  combinational 
filter  are  set  egual  to  zero,  and  new  velocities  along  the 
system  axes  are  calculated.  Figure  13  depicts  the 
navigation  mcde  test  and  applicable  equations  for  computing 
the  system  axes  velocities. 

In  order  to  save  execution  time  in  the  calculation  of 
the  formulas  and  to  simplify  the  PL/M  code,  the  functions 

(Vis  * COS(SHDGA)  +■  ViN  • SIN  (SHDGA)  ) 

(ViN  * COS(SHDGA)  - ViS  * SIN  (SHDGA)  ) 

were  calculated  prior  to  the  navigation  node  test.  Figure  14 
depicts  the  data  flow  grapn  for  these  two  functions.  After 
successful  computation  of  the  above  functions  and  tne 
navigation  mcde  test,  the  corrected  velocities  (VC2  and  VC3) 
along  the  system  axes  are  calculated  and  the  resultant 
values  used  in  the  navigation  routine. 


I 
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FIGURE  12  - NORTH/SOUTH/EAST/WEST  VELOCITY  DATA  FLOW  GRAPH 


46 


4 


FIGURE  14  - PARTIAL  FUNCTION  DATA  FLOW  GRAPH 
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N.\VIviATICN  PROC^ISSING 


In  the  nav  ivj arion  processing  routine,  the  Onega  systea 
position  aatrix  S [3  X 3]  is  initialized,  tne  angular 
rotations  (D£LI2  and  D2LT3)  about  the  systea  axes  are 
calculated  using  the  corrected  velocities  supplied  by  the 
velocity  processing  routine  and  the  state  vector  corrections 
iron  the  ccabinational  filter,  tne  systea  position  aatrix  is 
updated,  and  a neu  Omega  aircraft  latitude  (OLATAC)  and 
longitude  (CLG'IAC)  are  calculated.  The  flowchart  of  tne 
navigation  routine  is  shown  in  Figure  15. 


The  initialization  of  tne  Omega  system  position  matrix  P. 
occurs  during  the  initialization  function  when  the 
Navigator/Communicator  inserts  the  aircraft  initial  latitude 


(OLATIN)  and  longitude  (OLONIM)  • These  vain 

initial  condition  that  the  system  heading  angle 
zero,  are  input  to  the  equations  listed  below. 

.R1  1 = 

SIN  (CLATIN) 

R12  = 

CCS  (CLATIN) 

* COS  (OLONIN) 

R13  = 

COS  (CLATIN) 

* SIN  (OLONIN) 

.R21  = 

CCS  (ClATIN) 

♦ SIN(SHDGA) 

= 0 

R22  = 

-SIN  (OLCNIN) 
SIN  (CLATIN) 
-SIN  (CLCNIN) 

♦ COS(SdDGA)  - 

* COS  (OLONIN) 

* SIN  (SHDGA) 

R23  = 

COS  (OLONIN) 
SIN  (CLATIN) 
COS  (CLCNIN) 

* COS(SHDGA)  - 

* SIN  (OLONIN) 

* SIN  (SHDGA) 

R31  = 

COS  (OLATIM) 

♦ COS(SHDGA)  = 

COS  (OLATIN) 

= s , with 
(3HDG  A) 


an 


R3 


SIN(OLONIN)  * 3iri(SHDGA) 


SIN(CLaTIN)  * CCS(OLJNIN)  ■»  C03(SHDGA) 

= -3TN(CIATIN)  * C03(0L0NIW) 

R33  = -C03(CLCNIN)  * SIS(3HDGA)  - 

SIN(CLATIN)  * 3IN(0L0MIN)  C03(SH3GA) 

= -SIN  (OLATiri)  » SIN(OLONIN) 

These  nine  equations  represent  nine  direction  cosine  values. 
These  values  re^  resent  the  orientation  of  eacii  of  the  three 
system  axes  (PI,  R2,  and  33)  in  the  eartn's  fixed  coordinate 
frame.  In  constructing  the  data  flow  grapn  for  the 
initializdticn  equations,  the  concept  of  minimizing 
execution  time  prevailed,  and  as  variables  were  calculatei, 
they  were  stereo  in  memory  and  retrieved  as  they  were 
required  in  later  caiculat ions . Figure  16  portrays  the  data 
flew  graph  fer  the  initialization  of  tiie  position  matrix  3. 


50 


FIGURE  15  - NAVIGATION  PROCESSING  FLOWCHART 


OLONIN 


SIN 

COS 


After  ccnpletin'^  the  initialization  ^^naae,  t ae 
navigation  function  calculates  the  angular  rotations  (DiLr2 
and  DELTJ)  about  tne  systeia  axes  R2  ani  E3.  Tne  following 
equations  are  used  in  calculating  the  angular  rotations. 

DELT2  = -L  1 t EEC  ^ (2  * R312  - Rll^)  ] ♦ VC3  ♦ DTIJaV  - 

E.'IEE 

2 * EEC  » R2  1 * R3  1 * VC2  DTNAV  t 5<D3 

E.1ER 

DELT3  = [ 1 + EEC  * (2  * R212  - Rll^)]  » VC2  DCMAV  t 

EXZ?. 

2 ♦ EEC  ♦ P.2  1 * P3  1 ^ VC3  * DTMAV  - S'J)2 

E.'IER 

As  in  previous  equations,  converting  to  data  flow  grapr.s  was 
accctiplished  with  the  idea  of  ainijiizir.g  execution  tine. 
Figure  17  is  the  data  flow  graph  constructed  frooi  the  above 
equations.  Cnee  the  angular  rotations  are  calculated,  t.ae 
position  aatrix  is  updated  based  on  the  formula 

[R]new  = [RJold  + [ ^)  ] * [Rjold 

wnere  [ iji  ] is  the  rotation  update  aatrix  given  below. 

-(DELI2^  t DELT3^)  DELI3  -DSLT2 

2 

-DELT3  -(DELT3)  DELT2  * DEL73 

2 2 

DELT2  DELT2  * DELI3  -(DSLr2) 

2 2 

Simpiif icaticr  of  the  position  matrix  update  formula  is 
accomplished  utilizing  the  following  equations. 


■i 
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A(j)  = Rij  + R2j  * {DELT3  / 2)  - R3j  * (DELT2  / 2) 

3 = [ (DELT2)  2 ♦ {D2L:32)  ] /2 


m-?  'josition  ffdtrix  Ut>dcite  -ei^uations  are  th>=n  written  in  the 
tollouiiig  format. 


Rij 

= Rij  - 

Rij  ■* 

a + 32j  * DELT3 

S2j 

= f,2j  - 

DFLT3 

* Mi) 

S3  j 

= R J j + 

0ZLT2 

* A ( j) 

Rij  * DSLT2 


I at)iea9n  tat  icn  of  taese  equations  in  a data  flow  grrah  is 
depicted  in  Figure  18. 


Once  the  position  matrix  R is  upcatea,  the  last 
eg nations  to  caicuiate  are  for  updating  the  system  h-ading 
angle  and  the  aircraft  new  latitude  and  iongitide.  The 
eguations  listed  below  update  t.nese  three  system  variables. 


3HD3A  = AFCTAN  (R21  / u31) 

OLATAC  = AF.CTAN  [(311  * C03(3KD0A))  / P31] 

0L0;1AC  = ARCTAN  (K13  / R12) 


The  data  flow  graph  presented  in  Figure  19  depicts  the 
update  of  these  system  parameters. 
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FIGURE  17  - ANGULAR  ROTATIONS  DATA  FLOW  GRAPH 


FIGURE  18  - UPDATE  OF  POSITION  MATRIX  DATA  FLOW  GRAPH 


SHOGA 


I6URE  19  - UPDATE  SYSTEM  HEADING  ANGLE,  LATITUDE,  LONGITUDE 


From  the  data  flow  graphs  of  the  velocity  and  naviqa-ion 
tunction,  four  PL/M  floating  point  subroutines  were  written. 
The  subroutines  consist  of  an  initialization  (INITIALI^EiR) 
routine  for  initializing  the  position  natrix  R,  a velocity 
processing  (V2LPROC)  routine  for  conputing  the  velocities 
along  the  system  axes,  a navigation  processing  (NAVPROC) 
routine  for  calculating  the  angular  rotations  about  the 
system  axes,  and  a new  position  (NEWP05)  routine  for 
updating  the  position  matrix  R,  aircraft  system  heading 
angle,  ani  aircraft  latitude  and  longitude.  Based  on  the 
arithmetic  and/or  trigonometric  functions  used  in  the  data 
flow  graphs  and  an  approximation  of  the  time  reguired  to 
execute  each  function,  a preliminary  estimate  of  tne  time 
reguired  to  execute  each  suoroutine  was  acquired.  Utilizing 
INTSRP/80,  which  is  the  FORTRAN  IV  software  simulation  of 
the  INTEL  3060  CPU  and  is  available  on  the  IBM  360/67,  the 
actual  execution  time  of  each  program  was  acguired.  The 
following  chart  shows  the  numoer  of  arithmetic  functions 
used  in  each  subroutine,  tne  estimated  and  actual  execution 
times  in  milliseconds  of  the  subroutines,  and  the  storage 
utilized  for  each  subroutine. 
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Frca  th€  last  three  subroutines,  it  is  seen  that  the  total 
execution  tiae  of  562.5  milliseconds  is  between  two  and 
one-half  and  three  times  as  great  as  the  200  millisecond 
time  interval  currently  implemented  in  the  P-3C.  However, 
because  the  Cmega  navigation  display  for  Omega  latitude  and 
longitude  is  updated  every  second,  the  microcomputer 
subroutines  are  capable  of  providing  an  update  in  sufficient 
time  to  be  displayed  on  the  Omega  tableau. 

In  the  simulated  test  case  used  to  check  the  validity  of 
the  subroutines,  a navigation  cycle  time  (DTN.W)  of  1 second 
was  used  in  the  computations.  This  1 second  tiae  interval 
allowed  an  aircraft  traveling  at  300  knots  to  be  updated  at 
approximately  every  506  feet.  The  velocity  processing 
routine  was  able  to  calculate  the  velocities  along  the 
system  axes,  using  the  ?L/d  floating  point  function,  to  four 
digit  accuracy  (ie.  from  000.0  reet  per  second  to  399.9  feet 
per  second) . These  velocities  encompass  the  complete  range 
of  the  P-3C  airspeed  capaoi lit ies . 

The  calculations  performed  in  the  remaining  suoroutines 
presented  problems  when  using  the  PL/d  floating  point 
functions.  cecause  the  functions  utilize  a 1o  bit  mantissa, 
the  exponent  values  have  to  be  within  a range  of  2^*'  when 
adding  or  subtracting  two  numbers.  Because  the  difference 
oetween  the  calculated  angular  rotations  about  the  system 
axes  and  the  direction  cosine  values  in  the  position  matrix 
is  not  within  this  range,  several  angular  rotations 
calculated  ever  time  had  to  be  added  together  before 
updating  of  the  position  matrix  R could  be  accomplished. 
This  is  the  major  difficulty  with  the  subroutines 
implemented  witn  the  present  PL/M  floating  point  routines. 


59 


V.  CONCLUSION 


Based  on  the  subroutines  implemented  for  the  velocity 
and  navigation  function,  a microcomputer  is  capacle  of 
calculating  the  required  system  parameters  in  sufficient 
time  and  with  sufficient  accuracy  to  provide  reliable 
position  fixing  information.  Even  with  the  microcomputers 
primary  disadvantage  of  slower  execution  time,  the  position 
fixing  information  could  ce  displayed  at  one  second 
intervals  provided  a floating  point  package  which  operated 
with  a mantissa  of  24  bits  could  be  acquired.  Further 
research  of  the  remaining  internal  functions  and  tne  overall 
effect  they  have  on  the  velocity  and  navigation  function  is 
encouraged.  larticular  attention  should  be  focused  cn  the 
state  vector  elements  applied  to  tne  velocity  and  navigation 
equations,  and  their  relevance  to  overall  system  operation 
and  update  of  position  information. 


C5CLAPE  ZZ  ACCP.ESS,  ZE  EY^E; 


/ ’i' 

THE  ABCVE  VARIABLES  ARE  GLOBAL 
TO  TEE  floating  PCINT  SLBRGU'^INES 


ERPCF:  PECCEDURE ( I ) ; 

/* 

PRCCECLPE  TO  PROVIDE  ERROR  MESSAGES 
FCLLCi^ED  BY  TERMINATION  CF  PROGRAM  EXECUTION 
*/ 

DECLARE  I BYTE; 

CALL  CFLF; 

DC  CASE  I; 

/ ^ 

MESSAGE  FOR  UNIDERPLOW 

< / 

CALL  PP IMT<  EXECUTION  TERMINATEC  DUE  TO  UN CE PF LO « $ ' ) ; 
/ * 

MESSAGE  FOR  OVERFLOW 
* / 

CALL  PRINK  .'EXECUTION  tc:?  m ^ j g c Qjg  TO  CVERFLCWt'); 

MESSAGE  FOR  £OROR  IN  LCG-ARGUMENT 
=»/ 

CALL  PRINT!  ARGUMENT  FCR  LCG  NEGATIVE  OP  ZEROS’); 

/* 

MESSAGE  PQR  ERROR  IN  DIVISION 
*/ 

CALL  PRINT! .'ATTEMPTED  DIVISION  BY  ZEROS'); 

/ * 

MESSAGE  FOR  INPUT  ERROR 
* / 

CALL  PR INT !.' INPUT  ERRORS'); 

n 

MESSAGE  FOR  EXPCXI  CvERFLOW 
*/ 

call  print ( .'OVERFLOW,  ARGUMENT  FCR  EXP(X)  TCC  BIGS'); 

EMD; 

HALT  ; 

RETURN; 

END  ERROR; 


/* 

FLOATING  POINT  ACC  ROUTINE 
*/ 


ADD:  FPCCFDURE  (XA,YA,PA); 

DECLARE  XA  ACCRESS,  X BASED  XA  BYTE, 
YA  ADDRESS,  Y BASED  YA  BYTE, 
PA  ADDRESS,  P BASED  PA  BYTE, 
IDIFF, I, S IGN, XEX.YEX)  BYTE, 
(XX, YY)  ADDRESS; 

DECLARE  FOSITIV  LITERALLY  '<  80H', 
NEGATIV  LITERALLY  '=8QH'; 
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/'»■ 

PPCCECLPE  JC  left  JUSTIFY  '^A.MTJSSA,  CECREMS’riNG  EXPONENT 
*/ 

flCJUST:  PFCCECURE; 

CC  I=l  TO  16; 

IF  (ZZ  AND  800CH)=80C0H  THEN  RETURN; 

ZZ  = ShL  (ZZ,  1 ) ; 

P(2)  = (ZE  :=  F(2)  - 1); 

/* 

CFECK  FCP  UNDERFLC'Ai 
*/ 

IF  (F(2)  ANO  07FH)  = 0 THEN 
call  ERK(^R(C); 

END; 

PETUFM ; 

SNC  ACJUST; 

/ * 

ePI^G  ECTH  mantissas  and  exponents  in  working  area 
♦ / 

XX  = Shl(00U8LE(X)  ,8  ) CP  X(l>; 

VY  = SFL (OOU0LE( Y) , 8 ) 0°  Y(l); 

XEX  = X(2)  ANC  D7Fm; 

YEX  = Y(2)  AND  07Fh; 


/* 

CFECK  MANTISSAS  TO  SEE  IF  ZEoj 
IF  ( >x  = ocooH ) then  DC; 

ll  = YY; 

F (2)  = ( ZE  :=  Y(2  ) ) ; 

GC  TO  RET; 

ENC; 

IF  (YY  = OCOOF)  THEN  DO; 

ZZ  = XX; 

P(2)  = (ZE  :=  X(2)); 

GC  TO  PET; 

ENC  ; 

/* 

CALCLLATE  DIFFERENCE  BETWEEN  EXPONENTS  AND  CFECK  SIGN 
*/ 

CIFF  = XEX  - YEX; 

IF  (CIFF  AND  CeOH)  <>  0 THEN 
CIFF  = - DIFF; 

SIGN  = (X(2)  AND  080F)  XOR  (Y(2)  ANC  080HJ; 


CFECK  IF  OPERATION  BEYOND  SIGNIFICANCE 

♦/ 

IF  (CIFF  >=  16 ) then  CO; 

IF  (XEX  > YEX)  THEN  DO; 

ZZ  = XX ; 

= HIGH(ZZ) ; 

= L cw  ( Z Z ) ; 

= (ZE  ;=  XEX); 


p 

p(  1 ) 

P(2) 

END; 

ELSE  DC; 

ZZ  = YY; 
P 

F(l) 

P(2) 

END  ; 
RETURN; 

ENC; 


= HIGH(ZZ  ) ; 

= LCW(ZZ)  ; 

= ( ZE  :=  YEX); 
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IF  XEX  = VEX  THEN  00; 

/* 

EXFC^E^TS  ARE  EQUAL 

♦ / 

IF  XX  > YY  then  OC; 

/* 

CFERAiNO  1 > OPERANC  2 
*/ 

P(  2)  = ( ZE  :=  X(2  ) > ; 

IF  SIGN  FTSITIV  THEN 
GC  TC  EXI Tl  ; 

GC  TC  EXIT2; 

END; 

ic  YY  > XX  THEN  DO; 

/ » 

CFERANC  2 > QPERANC  L 
* / 

P(2)  = (ZE  :=  Y(2)  ) ; 

IF  SIGN  FQSITIY  then 
GC  TO  EXI Tl  ; 

GO  TC  5XIT3; 

END; 

/* 

OPERAND  1 = OPERAND  2 
*/ 

IF  SIGN  PQSITIV  THEN  DO; 

P(2 ) = ( ZE  :=  X (2)  ) ; 

GO  TO  EXITl; 

END; 

/« 

RESULTING  ZERO  FROM  EQUAL  NUMBERS  ViITH  DIFFERENT  SIGN 
*/ 

ZZ  = XX  - YY; 

P = HIGH (ZZ) ; 

P(i)  = LOW(ZZ) ; 

P (2  ) = (ZE  :=  OOOH  ) ; 

RETURN; 

END  ; 

IF  XEX  > YEX  THEN  DO; 

/* 

EXPONENT  CF  OP'=RAND  1 > EXPONENT  OF  CPERANO  2 
♦ / 

P(2)  = (ZE  :=  X(2)  ); 

YY  = ShR( YY  ,DIFF  ) ; 

IF  SIGN  POSITIV  THEN 
GO  TC  EXITl; 

GC  TO  EXIT2; 

END; 

/♦ 

EXPONENT  CF  OPERAND  2 > EXPONENT  OF  OPERAND  1 
4/ 

F(2J  = (ZE  :=  Y(2) ) ; 

XX  = SHR( XXjDI FF ) ; 

IF  SIGN  POSITIV  THEN 
GC  TO  EXITl ; 

ELSE 

GC  TO  EXIT3; 
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/* 

iCD  TWC  GFEPANCS  WITI-  EQUAL  SIGN 
♦ / 


EX  IT  1 : 

zz  = XX  > yy; 

IF  (CAPRY)  THEN  DG  ; 

ZZ  = SC5(ZZ,n; 

ZE  = ZE  + l; 

/* 

ACJUST  EXPONENT  ANC  CHECK.  FOR  OVERFLOW 
*/ 

IF  (P(2)  POSITIV)  then  DO; 

P(2 ) = ( ZE  : = P(2  ) + 1 ) ; 

IF  (P(2)  AND  080H)  <>  0 THEiN 

CALL  ERROR(l); 

END; 

ELSE  00; 

P(2)  = ( ZE  : = P (2  ) + 1 ) ; 

IF  (CARRV)  then 
CALL  ERROR! 1); 

END; 

END; 

GC  TC  RET; 

ACC  CRERANCS  WITH  DIFFERENT  SIGN 
=»/ 

EXIT2  : 

ZZ  = XX  - YY; 

CALL  ADJUST; 

GC  TC  RET; 

5 X I T 2 : 

ZZ  = VY  - XX; 

CALL  ADJUST; 

/ 4 

ASSIGN  RESULTING  YANTISSA  VALUES 
RET  : 

? = HlGh(ZZ ) ; 

F(U  = LOW  (ZZ)  ; 

RETURN; 

END  ACC  ; 


FLCATING  PCINT  SUBTR.AC''  ROUTINE 


SUE:  PRCCEDURE  tXA,YA,PA); 

DECLARE  XA  ADDRESS,  X BASED  XA  BYTE, 

YA  ADDRESS,  Y BASED  YA  BYTE, 

FA  ADDRESS,  P BASED  PA  BYTE, 

NEGY  (3)  BYTE; 

CHANGE  SIGN  OF  OPERAND  2 AND  CALL  ACC  ROUTINE 
4/ 

NEGY  = Y; 

NEGY ( 1 ) = Y( 1 ) ; 

NEGV(2)  =*  Y(2)  XOR  J80h; 

CALL  ADD(XA  ,.NEGY, PA  ) ; 

END  sue; 
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FLCATING  PCINT  MULTIPLY  ROUTINE  INCLUDING 
OFTICN  FCP.  H/iRCWAPE  »^ULTIPLY  JF  MANTISSA 

DECLARE  (MD  SSl.QT,  MDSOPT  ICN  ) BYTE  INITIAL  (0); 

MULT:  PFOCEOUPE ( XA,YA , PA  ) ; 

DECLARE  XA  ADDRESS,  X BASED  XA  BYTE, 

YA  ADDRESS,  Y BASED  YA  BYTE, 

FA  ADDRESS,  P BASED  PA  BYTE, 

I BYTE,  (CPI,  0F2)  ADDRESS; 


/* 

CFECH  FCR  ZERO  OPERAND 
*/ 

IF  (X=0)  CR  (Y=D)  then  DO; 

/=> 

IF  FCL'ND,  RETURN  ZE°C  AS  RESULT 
* / 

PIC)  = COOh  ; 

F(i)  = djjh; 

P(2)  = COOh; 

P ETURN; 

E^C; 

HARCV»ARE  CR  SOF-^WARE  MANTISSA 
4/ 

DC  CASE  MDJCPTIOM; 


CASE  C - SOFTWARE  MUL"^IPLY 
<■/ 


DC  ; 

/ * 

BRING  BCTH  MANTISSAS  IN  OPERAND  FIELDS 
*/ 

ZE  = SHR(  X(l),  1); 

CFl  = SML ( DOUBLE (X ), 7 ) ; 

CFl  = CPI  CR  ZE; 

CP2  = SHL( DOUBLE (Y)  ,8  ) ; 

CF2  = CP2  CR  Yd); 

/ < 

TFE  MULTIPLICATION  CF  ThE  MANTISSAS  15  OCNE  IN 
HAPCWARE-LIKE  FASHION  BY  SHIFTING,  COPYING  AwC 
ADDING  CF  operand  1 FOP  EVERY  1 FCLND  IN  CPER- 
AND  2;  AND  BY  SHIFTING  ONLY  poR  EVERY  j FCUND 
IN  OPERAND  2,  STARTING  WITH  THE  LEAST  SIGNIFI- 
CANT 1 
’>/ 

/* 

INITIALIZE  WORKING  FIELD 
*/ 

ll  = 3; 

ZE  = o; 

/» 

SFIFT  OPERAND  2 BIT  6Y  BIT  THRCLGH  CARRY  AFTER 
SHIFTING  OF  AOHED  RESULTS  IN  WORKING  FIELD  HAS 
BEEN  OCNE 
♦/ 
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CC  1=0  TC  15  by  l; 

ZZ  = SCfi(ZZ,  1 ) ; 

CP2  = SCR(0P2,  1 > ; 

/* 

CHECK  IF  A 1 HAS  BEEN  SHIFTED  INTO  THE  CARRY 
*/ 

IF  (CARRY)  -^HEN  DO; 

/* 

IF  YES,  ADD  OPERAND  1 TO  THE  CCN-^ENTS  CF  TFE 
WORKING  AREA 
*/ 

ZZ  = ZZ  + CRl; 

END; 

END  ; 

I* 

NCRYALIZE,  IF  NEEDED 

IF  (ZZ  < 80C0H)  THEN  00; 

ZZ  = SHL  (ZZ,  1 ) ; 

SET  ADJUSTMENT  FCR  EXPONENT 

ZE  = -1 ; 

END; 

FAC;  /=»  CASE  0 

/< 

CASE  1 - FARCWARE  multiply,  SLOT  0 
DC; 

OUTPUT! C)  = X(  1 ) ; 

CLTPUT ( 1 ) = X ; 

CLTPUT(2)  = Y(1  ) ; 

OUTPUT! 3)  = Y; 

ZZ  = SFL (DCUBLE ( INPUT ( 3 ) ) , 8 ) + CCUBUE ( I N PU T ( 2 ) ) ; 
IF  (ZZ  AND  aOOOH)  = 0 THEN  DO; 

I = SCL ( INPUT ( 1 ) , 1 ) ; 

ZZ  = SCL  (ZZ,  1 ) ; 

ZE  = -l; 

END; 

ELSE 

ZE  = 0; 

EAC;  /«  CASE  1 */ 

/« 

CASE  2 - HARDWARE  MULTIPLY,  SLOT  1 

♦/ 


OufPUT! C4H)  = X(  I ) ; 

CUTPUT(05H)  = X; 

CLTFUT(C6H)  = Y(1  ) ; 

CLTPUT(07H)  = Y; 

ZZ  = ShL(  DCUBLE  ( INPIJ-^  (07H  ))  ,3  ) + DOUBLE  ( INP U T ( 06H  ))  ; 
IF  (ZZ  AND  8C00H)  = 0 THEN  CO; 

I = SCL ( INPUT ( C5H)  , 1 ) ; 

ZZ  = SCL  (ZZ,  1 ) ; 

ZE  = -l; 

END; 

ELSE 

ZE  = o; 

EAD;  /♦  CASE  2 ♦/ 


•» 
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/* 

CASE  2 


HARCk^iRE  multiply,  SlCT  2 


DC" 

OUTPUT ( C8H  ) = X(  1 ) ; 

OUTPUT (J9H)  = X; 

CUTPUK  CAH  ) = Y(  1 ) ; 

CUTPUT(OEh)  = Y; 

ZZ  = SHL( DOUBLE ( I NPUT (J3H n ,a  ) + COUSLE ( INPL ^ (OAH  ) ) ; 

IF  (ZZ  AND  eOOOH)  = 0 Tf-EN  DO; 

I = SOL ( INPUT ( 09h) , 1)  ; 

II  = SCL  (ZZ, L ) ; 

ZE  = -i; 

END; 

ELSE 

ZE  = 0; 

E^C;  CASE  3 


CASE  A - FARCmARE  multiply,  SLOT  3 
=»/ 


CO  ; 

CLTPUT ( OCH  ) = X ( 1 ) ; 

CLTPUT(CDH)  = X; 

OUTPUT (OEH  ) = Y(  1 ) ; 

OUTPUT ( JPH  ) = Y ; 

ZZ  = SHL( DOUBLE ( I NPUT(OFh)  ) ,8 ) + CCUBLE ( I N PLT (0  EH ) ) ; 
IF  (ZZ  AND  8000H)  = 0 THEN  DH ; 

1 = SCL(  INRUT( JCH)  ,1); 

ZZ  = SCL (ZZ , 1 ) ; 

ZE  = -L  ; 

END; 

ELSE 

2 E * 0 * 

END;  /*’CASE  A */ 

END;  CASE  I STATEMENT  =»/ 


/ « 

SUM  UP  EXPONENTS  AND  ADJUSTMENT 


R(l)  = (X(2)  AND  7FH)  + (Y(2)  AMD  7FH)  ; 

P(2)  = P(1 ) + ZE  - 6A; 

/* 

CHECK  FOR  C^ER^LCW  ANC  UNDERFLOW 
4/ 

IF  (CARRY)  then 
CALL  ERROR ( C) ; 

IF  (F(2)  AND  J8JH)  O J THEN 
CALL  ERROR ( 1) ; 

/4 

SET  SIGN  BIT 
4/ 

P(2)  = P(2)  OR  ((X(2)  AND  C80H)  XCR  (Y(2)  AND  C8CH)); 


/♦ 

ASSIGN  MANTISSA  VALUES 
4/ 

F = HIGH( ZZ  ) ; 

F(l)  = LOW(ZZ); 


RETURN; 
END  vulT; 


f 


& 
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/« 

FLC-lTihG  POINT  CIVIDE  oqut  INE  INCLUOING  DIVIDE  B 't  HAPCk^/loE 


DIV:  Pf  CC£CU=^  c (XA  ,YA,  PA  ) ; 

declare  >a  address,  X BASED  XA  BYTE, 

YA  ADDRESS,  Y BASED  YA  BYTE, 

FA  ADDRESS,  » BASED  PA  BYT=, 

(OPl,  GP2,  OIFF)  ADDRESS, 

I BYTE,  C (3)  BYTE; 

/ * 

BRING  BOTH  MANTISSAS  IN  OPERAND  FIELD 
/ 

CFl  = SHL(  DGU6LE  (X  ) , 8 ) OR  X(U; 

CP2  = SHU  CGU3LE  ( Y>  , 8 > CR  Y(l); 

/=> 

CFECK  FOR  ZERO  IN  DPERAND  I 

IF  X = 0 THEN  DC; 

/« 

IF  FCLND  RETURN  ZERO  AS  RESULT 
«/ 

PIC)  = CCOh; 

P ( 1 ) = CCOH  ; 

P(2)  = 003h; 

RETURN; 

END  ; 

/* 

CFECK  FOR  ZERO  IN  OPERAND  2 
=>/ 

IF  Y = 0 THEN 

CALL  ERFCR(3); 

/♦ 

3 = SCFTWARE  CIVIDE,  1-A  = HARDWARE  CIVIDE 

DC  CASE  YDSCPTICN; 

/ ♦ 

CASE  3 - SCFTWARE  DIVIDE 
*/ 

DC ; 

/* 

BEGIN  DIVISION  BY  SUBTRACTING  BCTH  OPERANDS  RESP. 
TFE  DIFFERENCE  AND  SH I F T ING/ ADO  I NG  BITS  TO  THE  RE- 
SULTING MANTISSA  FCR  EACH  POSSIBLE  SUBTRACTION  WiTr 
POSITIVE  RESULT,  AND  SHIFTING  ONLY  AND  ADDING  ONE 
PLACE  TO  OPERAND  1 IN  CASE  SUBTRACTION  YIELDED  A 
NEGATIVE  RESULT 
*/ 

CFl  = SHR(CFl,l)  ; 

CF2  = SHR(CP2, 1)  ; 

ZZ  = J; 

ZE  = o; 

I = l; 

C IFF  = CPI  - OP2  ; 


IF  NOT  CARRY  THEN  DO; 

IF  0 1==^  = 0 THEN  DO; 

/* 

RESLLT  FOP  NJM6EP  CIVIDEC  BY  ITSELF 
4/ 

ZZ  = 8000H; 

GC  TC  SETX; 

E^O; 

GO  TC  NO  CARRY; 

END; 

CFl  = SFLCCFl, 1 ) ; 

ZE  = -1 ; 

NEXTSTEP : 

C IFF  = CPI  - QP2  ; 

IF  CARRY  THEN  DO; 

CPI  = SHL(0PL,1); 

GO  TO  SHIFT; 

END; 

/ i 

^C  CARRY:  SET  OPERAND  1 TO  SHIFTED  DIFFERENCE, 

ADD  ONE  TO  RESULTING  VANTISSA 

NCCAPRY: 

CFl  = 3HL( D IFF, 1 I ; 

ZZ  = ZZ  + i; 

/« 

SHIFT  MANTISSA  ONE  PLACE  TO  ThE  LEFT 
♦/ 

SHIFT: 

ZZ  = SHL(ZZ,1)  ; 

I = I + l; 

/=» 

REPEAT  LNTIL  NORMALIZED 
«/ 

IF  I < 16  THEN 

GC  TC  NEXTSTEP; 

/♦ 

SET  EXPONENT 
«/ 

SETX: 

ZE  = (X(2)  AND  07Fri)  - (Y(2)  AND  C7FH)  ♦ ZE  + 65; 

CHECK  FOR  OVEPFLCV<  AND  UNDERFLOW 
* / 

IF  (ZE  and  C7Fri)  < 0 THEN 
CALL  ERROR (0) ; 

IF  (ZE  AND  080H)  <>  0 THEN 
CALL  ERRCR ( 1 ) ; 

/* 

SET  SIGN  BIT 
♦ / 

P(2)  = ZE  CR  ((X(2)  AND  080H)  XCR  (Y(2)  AND  080H)) 

ASSIGN  RESULTING  MANTISSA  VALUES 
*/ 

P = H IGH  (ZZ)  ; 

P ( 1 ) = LGW( ZZ) ; 

return; 

e^c;  /*  CASE  ) 
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/ * 

CASE  I - H^POwfiRE  CIVIDE,  SLOT  0 
</ 


cc ; 

OLTPUK  30H  ) = Y(  1 ) ; 
CLTFUK  31H)  = Y; 
CLTPUT03H)  = 0; 

C = I.NPUTCilH)  ; 

C ( 1)  = INPU'^ODH)  ; 
END;  CASE  L */ 


CASE  2 - HARDWARE  DIVIDE,  SLOT  1 


c c * 

CLTPUT  (3-^H  ) = Y(  1 ) ; 
CLTFUT(35H)  = Y; 
OUTPUT!  27H  ) = O; 

C = INPUT(35H); 

C ( 1)  = INPIJT(34H)  ; 

ENC  ; /*  CASE  2 *=/ 


/* 

CASE  3 - HARDWARE  DIVIDE,  SLOT  2 


DC' 

CLTFUT ( 33H  ) = Y ( 1 ) ; 
OUTPUT!  39H)  = Y; 

CLTFUT!33H)  = 0; 

C = INPLTI3SH); 

C ! L > = INPUT! 38ri ) ; 
E>C;  /*  CASE  3 */ 


/ < 

CASE  H - HARDWARE  DIVIDE,  SLOT  3 


DC ; 

OUTPUT! 3CH  ) = Yl  1 ) ; 

CLT0UT!3CM)  = Y; 

CLTPUT!3PHi  = 3; 

C = INPLT!3DH); 

C ! 1 ) = INPUT!3CH ) ; 

E^C;  CASP  ^ =^/ 

END;  /*  CASE  I STATEMENT  «/ 

n 

NULYIPLY  RECIPROCAL  Y BY  X TO  GET 
RESULT  FOR  HARDWARE  CASES 

IF  !Y!2)  AND  7FH)  < 2 THEN 

n 

CVEPFLCW  PROTECTION 

c c * 

C!2)  = (Y!2)  AND  6DH)  OR  !7FH  - (Y!2)  AND  7FH)) 
CALL  MULT! XA, .C  ,PA)  ; 

IF  !!P!2)  AND  7FHJ  2 1 > 7FH  THEN 

/ * 

OVERFLOW 

*/ 

CALL  ERROR!!  ) ; 

ELSE 

P!2)  = P(2)  > 2; 

ENC; 
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ELSE 


/ * 

NC  CVEP.FLQW  PRCTECTICN  fJEEDED 
CC  ; 

C(2)  = (Y(2)  AND  63H)  OR  (81H  - (Y(2)  AND  7Fh)); 
C 4lL  mult ( XA, .C , PA ) ; 

ENC  ; 

= ETUCN  ; 

ENC  civ; 


SCRT:  FFCCEDUR5  (XA,PA); 

DECLARE  XA  ADDRESS,  X 9ASED  XA  3YTE, 

PA  ADDRESS,  P BASED  PA  BYTE, 

(C ,C1  ,C2  ,C3 ,B ,B1  ,B2 , R)  BYTE; 

/» 

ASSLME  THAT  XA  IS  A POSITIVE  REAL  NUVBER  AND  TFE 
initial  APPSCXirOTIGN  FOR  THE  RGO^  IS  VANT^5XP/2 

B = X ; 

8 1 = X ( 1 ) ; 

°2  = X (21  - AH  ; 

IP  (E2  AND  OaCH)  = 0 then 
62  = SHR ( B2 ,1  ) + 64  ; 

ELSE 
CC ; 

62  = -B2; 

82  = ShR(32,l)  ; 

52  = 64  - B2; 

E^C; 

CC  P=1  TO  4; 

call  div(xa,.b,.c); 

call  A00( .C, .3, . b ) ; 

e (2)=B(2)-1 ; 

END ; 

P = b; 

F(  1)  = 6(1); 

F(2)=  6(2)  ; 

RETLPN  ; 

ENC  SCRT; 

DECLARE  ( ID,  TEMP, -^EMPl  ,TEMF2  , ENTRY,  ENTRYl  ,ENTRY2  ) BYTE; 


COMPARE:  FPOCEOUPE  (XA,YA)  BYTE; 
DECLARE  XA  ADDRESS,  X BASED  XA  BYTE, 
YA  ADDRESS,  Y BASED  YA  BYTE, 
(CHECKl,  CHECK2)  ADDRESS, 
(XP,YP,XE,YE)  BYTE; 

/♦ 

MOVE  EXPONENTS  INTO  WORKING  AREA 

*/ 

XE=X (2 ) AND  80H; 

YE=Y(2)  AND  8JH; 

IF  ( XE  = YE » THEN  DO  ; 

/♦ 

EXPONENTS  EQUAL 

*/ 

XP=X(2)  AND  7FH; 

YP*Y(2)  AND  7FH; 
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/ ^ 

MCVE  VAMISSAS  INTC  »JCHKING  AREA 
* / 


CEECKl =SHL ( CCUBLE  (X  ) ,8  ) OR  X(l); 

CEECK2=5HL( C jUBLE ( Y) ,8 ) OR  Y(l); 

IP  (X5  = 08CH)  THEN  DO; 

IP  (XP  < YP)  THEN 
RETURN  2; 

IF  (XP  > YP)  THEN 
RETURN  0; 

IF  CHECK2  < CHECKl  THEN 
RETURN  J; 

IF  CHECK2  > CHECKl  THEN 
RETURN  2; 

RETURN  1 ; 

END; 

IP  (X?  < YD)  THEN 
RETURN  0; 

IF  (XP  > YP  ) THEN 
RETURN  2; 

IF  CHECK2  < CHECKl  THEN 
RETURN  2; 

IF  CHECK2  > CHECKl  THEN 
RETURN  0; 

RETURN  l; 

PNC' 

IF  (>e’=  0)  then 
RETURN  2; 

RETURN  D; 

ENC  COMPARE; 

DECLARE  (T  ,T1  ,T2, Z,Z1 , Z2)  BYTE; 

FUNCTION:  PRGC ECU  PE ( I , X A ) ; 

DECLARE  I BYTE,  XA  ADDRESS,  X BASED  XA  EYTE; 

/* 

I=C  AlAN  = ATANGENT 
1=1  IS  NOT  USED  presently 
1=2  CCSSIN  = COSINE  AND  SINE 
«/ 

/* 

CCS:  PRCCEDURE  ( XA  ) ; 

♦/ 

DECLARE  TEMPCCS  (195)  BYTE  INITIAL( 

CCCH,CCOH,OCOH,CC9H,00£H,038H,OC9H,OOEH,03CH,  096H  ,0CAh,O3CH, 
0C9H  ,CCEH,030H, 

JFPH ,05 IH ,C3DH ,396H,JCAh,J3EH,0AFH,3ECH,03EH,OC9H,OOEH,O3EH, 
DE2H,02FH,C3EH, 

0FeH,051H,C3EH,O8AH,039H,03FH,095H,0CAH,C3FH,JA3H,J5BH,a3FH, 
CAFH  ,CECH ,03FH, 

OBC  H,  C 7 DH,03FH,0C9H,  ODE  H,  03FH,0D5H.,C9EH,C3FH,  OE  2H  ,02FH,03FH  , 
0EEH,JCGH,D3FH, 

0FBH,C5 1H, C3FH,082H,OF 1H , 040H , 09 AH , 039H , O^OH , 090H  , 082 H, 040H  , 
096H ,00 AH,O^OH, 

09DH ,012H,04JH, JA3H, J50H, G40H , 0A9 H , J A3 H , O^OH, 0 AF H , OEC H , O^OH  , 
0B6H  ,03  AH  ,OACH  , 

O0CH,C7CH,O4OH,OC2H,OC5h,CAOH,OC9H, OOEH,CAOH, JCFH  ,D5bH,  34 OH  , 
0D5H ,CSEH  ,C40H, 

ODBH,CE7H,040H,OE2H,02Fh,040H,OE8H,0  7 8h,040H,OEEH  ,0C0H,040H  , 
0F5H  ,0CSH  ,04DH, 

OFRH.CS  lH,C40h,CbCH,0CCH,04lH,08  3H,0FlH,C41H,08  7H  ,015H,04lH, 
08AH,C39H,041H, 

08DH,C5Dh,C41H,090H, J82H,041H,093H,OA6H,041H,096H,OCAH,041H, 
099H  ,OEEH  ,041H  , 

09DH ,012H,041H,0A0H,O37H, C41H,0A3H,05BH,C41H,  JA6H  , 0 7FH , 34  IH  , 
CA9H  ,CA 'H  ,041H, 

OACH,OC8H,041H,OAFH,OECH,041H,033H,01CH  ,C41h,0B6H  ,C34H,041H  , 
aB9H,C56H,041H, 

OBCH  , C 7DH,  04  IH  ,0BFH,0A  IH  ,C41H  ,0C2H,0C5H  ,041H,0C5H.  ,0E9H,  041H  , 
0C9H,0CFH,041H  ) ; 
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CEClARE  VALCOS  (195>  BYTE  INITUU 


08  0t-  ,C0CH,0^1 1-,  OFFh,OEC  H,  O^OH,OFRH,  OB  IF  ,OAOh,  0 FPF  , C4EH  , C40F  , 

3FEFt0CAF»J40F* 

OFEF,013F,040H,OFDH,03AH,040H,OFCH,03eF,040H,OFaF,Ol4F,04GF, 
of<;f  ,cc7f  ,040f  , 

OFeh.CEAH.jHOF.OFbH.OBAHtO^OHtOF^FtOFAFtO^OHtOFaFtOlAF.O^CF, 
OFIF ,CC9F,040H, 

OEEF,OCeF,040F,JECF,J83F,343F,J5AH,3JAF,J4Jrt,3E7F,36CM,040F, 
CEAF  ,CAAH,04CH, 

OclF,OC6F,OfCF,OOEH,OBEH,OAOH,003F,09AF,OAOF(,OC8H,CA9H,CACF, 
ODAF  tOCBF  ,04JF» 

OD IF , GAEF ,OAOF ,QCOH, 09FH ,OAOH  , 0C9 H , OD2 F ,0 AOH , OC5 F ,0£5H, OACF  , 
OClF  ,CC9F,CA0F, 

JBDF , 30  CF , JA3F , 00 9H , 069 F , OAOH , 0B5 F , 006 F ,040ri , 0 B OF  , 0 67 H , 0 AO F , 
0A3F  ,CECF,CA0H, 

0A7h ,C3  7F ,OAOF , JA2H, J69F, JA3F  ,39DF, 38  1 F , 0 A 3m , 3 9 6H  , 3 8 1 H , 3 A 3F  , 
C93F,C6AH,CA0h, 

03EF  ,O3  0F,OAOF,  08  8H,  0F7h,  O^OH  ,0-8  3F,  C9FH  , CAOH,  O^CF.CElHtOEFi-, 
3FIF  ,35F^  ,33  = F, 

CE6F  , C3  6F  ,03FH  , 0DAH,0El3F,03FH,0rFh,0dQF,03FM,0C3F,0fAF,C3FF, 
0S6F  ,CA9F ,03FF, 

3ACH , 38  2F , 33FH , OA CH , OAOF , C3FH , 09A F , 0 A5 F , 03 Fh,  083F,G9AF.0  2FF, 
0F8F  fCCBF ,03E  H, 

CEOF ,C6  6F,03EF,3C7h, JD2F,33EF,3A  = F,3 ICF,0  3EH, 3 96f,  JACH,  3 3EF, 
OFAF ,CCCF  ,C30F  , 

0C8F,CD6F ,03CF,096H,0C5F, 03nH,OC9h, 03AH,03Cm, OC9m,C7=H,033F, 
330F  ,0:CF , J03F ) ; 


DECLARE  CIFPCCS  (195)  BYTE  INITIAL  ( 


CC9H,CC5F,0BAH,  396H,  3C  1 F,  3BCF1, 3 FBF,  3 2 7F,3BCH,  3A  Fh  , 3B3F,  3BDF  , 
C£  IF,C3£H,0BCF, 

089F, OCCF , OBEF ,0A2H, 0A8H, OBEH  tOBBF, 06BF, OBEH, ODAh  ,3  I LH, 03EF  , 
3ECF  ,397F  , 3BEF  , 

C82F,C7BF,03FF ,08EH,098H,CBFH,09AH,09EF  ,OBFH, 0A6F  ,CSCF, OBFH  , 
0B2F  ,C6  IF  tOBFF, 

OBEF ,31AF,OBFH,CC9H,0S6FtCBFH,0D5F,03  3F,C3FH,0E0F  ,C3Eh, ceFF, 
CEBF,0CEF,03FF, 

3F6H  ,0CCF,08FFi,  38  3F,  355  F , JC3F , 33& F , 3A9F  , 3C3H,  3 3BF  , 3 98H  , 3C  3F  , 
C9CF,C01F,CC3F, 

0 95  F,  OFAF  ,0C0F,09BH,C00F,0C0H,  C9FH,0F  AhtCCOH,  OA-fF  ,OCPH,OCOh  , 
0A9F,391F,3C3H, 

0AEF,039F,OCOH,CB2H,0C6H,CCOH,O87H,O3  7F,OCOHt  3B0H  ,08CH,0C0F  , 
OBFF  ,CCAF,OCOF, 

3C3F,3CFH,0C0H,0C  7H , OOBF , OCOh ,0CBF » 0 69 F ,OCOh, OC FF  ,0 7 7H , CCOF  , 
0D3F  ,01 £F,OCOF, 

0D6F ,093F ,3CJF, 3D9H, 3EFF, 3C3H, 3DDF,32AF, JC3H, 3E JH  ,3A3H, 3C3F  , 
CE3F,C39H,0C0F, 

0E6F,00CF,0C0h,0E8H, JBCF,0C0H,0E8H,0A8H,CC0H, OECF,OAFH,OCOH, 
3EFF  ,3F2F ,0C3H, 

OF2F,OIOF,OCOH,OF AH,00  9H ,OCOH,OF5H,ODCH,OCOH, 0F7H  ,089H,0C0H  , 
0F9F  ,01CF,0C0F  , 

3FAF,37CF,0C0H,0FBH,0AAF,0C0F,0FCF,0BCF,0C0H,0FCF,0A9H,0C0F, 

OFEF,C6eF,OCOF, 

CFFH,C0CF,3C3F,3FFH, )82F, JCJH,3FFF, 3C1F,0C3H, 3FFH,0F9H, 0C3H, 
CCCF,0CCF,0C0F) ; 


/<■ 

PROCEDURE  (XA); 

CECLfiRE  TEmP^T&N  (249)  EYTE  INUIAK 


OOOH ,CCCh ,000H, OSOH.OOOh, 038H 
CeCH iCCCh  ,030H  , 
0ACt-,CCC)-,O3CH,OCCH,COOh,C3CH 
C90R  ,0321- , J3EH  , 
OACH,OCCH,C3EH,08Ch,OOOH,C3EH 
CECE,0CCR,03Et-  , 

OR  CH , JC :H , 332H ,3  8 JH , 3 J Jh,  J3FH 
0S8R,CCCR ,03PH, 
OACR,CCOH,C3RI-,OA8H,OQO)-,C3FH 
CCCh,CCCR,C3Fh, 
OC8R,CCCH,C3RH,OiJCH,OOOh,03FH 
0E8F ,CC:F , 33FF  , 
CFC)-,CCCh,O3FH,CF6H,C0Oh,O3FH 
0eeF,CCCF,040H, 
J8rH,0J>,040H,09:H,  J30H,  J40H 
09Cl-,CCCR  ,C40H, 

OAOhtCCOF ,040H, OA44,OOOh, C40H 

CPCR  ,CCCR  ,C40h  , 

OB4h,CCOR,C40R,CB8H.OOOH,C40H 

0C4R,OCOR,O4OH, 

CC8R,CCCR,040H,0CCh,C00H,040H 

OC8R,OCCR,040F, 

JE0H,OOJH,O4Jh,0E6H,OJOH,O4OH 

C80R ,CCCF  ,041R  , 

082h,C7CH,C4lH,084H,CElR,C4lH 

C8ER  ,CA5H,04l(-, 

093R,Ce  7l-,041h,C98H,069H,  041H 
OA7R,OOrF,04lh, 
OAbl-,CFC)-,O41H,C0CH,OD2h,C41H 
0fiFR,C78F,C41h, 
0C^H,C5AH,041H,  3C9H,03CH,  J41H 
0D7h,0E  IF ,041R, CDCH,0C3H,041H 


, 08GI-,  OOJR  , J3CH,  JCOH  , J JJH,  0 3CF  , 

,0E  Oh , OOCH  ,0  3DH, 0 8CH  ,CCOH, 0 3EH  , 

,OCOt-,OOOF,03  5H,OCCR,OOOH,03EF, 

,)88h,J0DF,03FH,09C(-,0C0H,03FF, 

, O6CF,OGCF,J3Fri,DB8H,JJJH,03FF, 

,OD8h,OOCH,03FH,OECb,CCOH,03FH, 

,08  0H,00  0H,040H,0  8‘tH  ,0001-,  040  F, 

,094F, JOOF,040H, 098F ,OCOH, 04CF, 

,OA3H,OOCF,04OH,  DACH  , 0 OOH , J40F , 

,03CH ,OQCH  ,040H, OCCH ,0COH,O4CF, 

,ODOF,OOOF ,040H,0C4F ,000F,040F , 

, OF  3F, 0 OOF  ,040H, 0F8F ,OCOH, 040F , 

,087F, 05  2F,041H,  J89H  ,0C3H, 041F, 

,09DH,048H,041H,OA2H,02DH,C41F, 

,0B5h,064F,041H,0eAF,096F,041F, 

,OCEH,  01  EF,  04  1H,OC2F,OF'=H,041F, 
,OElH,OA5F,O4lH,OEfcFi,08  7H,041F) 


DECLARE  vaiA''AN(  249)  BYTE  INITIAL( 

JOOF,00:F,OJOH,OFFH,OFAH,J3AFi,OFFF,JEAF,03BH,03FH,ODCF,0  3CF, 

CFFF,0AAF,03CF, 

09RF  ,0ACF,030F,  0EPH,070F,  03DH,00FH,01CF,C3DH,  OFEH  ,OAOH,  0 3CFi  , 
08FF  ,CCFF  ,03EFi, 

09EF,Ce  7H,0  3EF,0AEH,04CF,  036H,O6Dh,OC8H,03EH, OCDF  ,0  35H,0  3EF  , 
OCCF  , 08  6F ,03EH, 

0EBF,CBEF,03Eh,CF  An,  QDBH  ,03EH,C84ri,0EEH  ,03FH,  08CF  ,05Fh,03FF, 
093F,CC  1F,03FF, 

09BF ,C13F , 03FH, OA 2h, 055F, 03 Fh,JA9H, 08 EF,03FH,OBOF,OA4H,03FF, 
C07F,CBCF,O3FF, 

06EF,0ABF,03FF,0C5H,092F,03FH,0CCh,066F,C3FH, 0C3H,027H,03FF, 
0D9F ,CC4F ,03FF , 

0E0F,0ftCF,0  3FH,  OE6H,OF2H,  03FH,0ED)i,  063H  ,03FH,  0F3F  ,CBFH,  03FF  , 
CFAF,0C6F,03FF, 

080F,ClCH,C40H,C3  3H,02BH,C40H,Oa6H,03  0H,040H,  08  9H  , 02  AH, 040 F, 
08CF ,01AF ,C40F, 

O8FF,OCOF,O4Oh,J91H,OO0h,O4OH,O94H,OACF,O4OH,  397H  ,073H,040F  , 
09AF ,02FF ,04CH  , 

09C(-,CE  1F,040H,C9FH,089H,  040H,0A2H,  02  8F  ,C40H,  0A4H  ,OBCH,  04 OF  , 
0A7H,C48F,C4CH, 

0A9F,CC7F,04OH,0ACH,03EH,04OH,0AEH,C'ACh  ,040H,OB1H  ,010H,040h  , 
083F,C6SF,040H, 

OB  8 F,  C C 5H,  C40H,  OBCH,  07BH,040H,OC  OH,  or,  EH  ,040H,  0C4F  ,0FFh,040F  , 
OC9F,CCFF,C40F, 

OCBF,C7AH,040H , 0CDH,0DAH,  04  0H, OOOF, 02EF  ,04  0H,  0 C2 H , 0 76H , 040F  , 
0D6F ,CE  7F  ,040H  , 

0CBF,C2CF,04OH,0DFh,O4AH,040H,0E3H,04iH,C4  0H, 0E7H  ,013H,  04  0H  , 
OEAF,OC  Ih  ,040H, 

OEE  F,C4CH,0  40H, OF IH , OB 8 H , 040H , OF  5H , 004H , 040H , 0 F 8H  ,0  32H ,040H  , 
OFPF  ,044F  ,04  OH, 

OFEF ,03BH,C40H , 08CH, 08CH ,04 IH,081H,0EDH,041H,083H,043H,041F, 
084F,C8EH,041H,08  5H, 0CEH,04 lH,03  7h,0C3H ,C41H,  088H  ,C2FH,041H  ) 
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CfECLARE  CTFFAT4N  (249)  SV^E  IMT!AL( 

OF^F  ,0F  Al-,040  H,  OFCHtODAH,  'J40h,  OF-H,  09  A H , C4  OH  , 0 F F H , C 3eH  , J4  Ch  , 
CFEF ,03CF  ,C40F  t 

OFEH,0  1rF,040H,  OFCh,'16  1H,04  0H,OFCH,  08  7H,G4  0H,  OFBH  ,08EH,04GH  , 
OFAF ,07  Ah ,04  )H , 

CF9H, C4  9H,C4GH ,GF  7H, 0FDH,C40H  , OF 6h , 09 6 H , 040H , 0 F 5 H ,017H,040F  , 
0F3F,07FF, 04  OH, 

OF1H,OCDH,  040F,OFCH,ODAH, J40H ,7EEH,D30F,04  0H,JECH,  :41H, 040F  , 
CEAF,03FH,04CH, 

0E8F,02CF,040F, CE6H,C09H, 040H,QFLH,006H , C40H, 0ElH,C95H,J4JH, 
0DFH,J47H,C4CH, 

0CCF,0ECF,O4OH,ODAH,088H,C4CH,0D8H,019H,04GH,005H,0A2H,040Ht 
0D3H,024f,  J40H, 

OECh,  C9Eh,  040H  , OC  , 0 1 3 H , 0 4CH  , OC  B H , 08  4 H , 040H  , 0 C 8H  ,0FLH,040F  , 
0C6F ,05BF , 040H, 

JC3F,0C4H,J4  0H,0C1H,  02  3H,J4  0H,06EH,092H,D4JH,0BBH,  OF Ah, 040 H , 
CB9h , 06  2H ,04Ch  , 

CB6H  ,CCCF,040H, 334H,033H,040H,0B  lH,OA8h,04  0H,CAFH,ClBH,  04  0H, 
aACH,092h,C4CH, 

OA A h,0CCF,0 40 H, OA  7H,  080 H, 04CH,0A  5 H, 0 1 2H  ,04 OH, 0A2H  ,09CH, 040H  , 
CA0H,025H,  J4JF, 

C9CH,CC5h,C40F, C9eH,063H,04  0H ,099H,00  7H,040H,  0 96H  ,0B2H,O40H, 
092F  ,0A  lH,C40h, 

08EH,OC‘ih,04JH,J8AH,  06  5H,J4  0H,086h,025h,04JH,  0 62  h , 0 05  ri  , 040  F , 
CF'LF,C92F,03FF  , 

0FiF,OCaF,O3FF,OF4H,Oi6H,03FH,C6FF,O7CF,C3FH,0E6H,CC3H,J3FF, 
OEOF  , 01 AF ,C3FF , 

CD7F,OCCF,O3FF,0CFH,0O7F,03''H,OC8h,O3  8H,03FH,OCCH,0EEH,03'"F, 
CB9F,0F2F,03FF, 

C8  3F,C4  6H,C3‘^F,OACH,Cc7H,03FH,OA6H,OCCF,O3FH,  OACF  ,0F3h,O3FF, 
09BF,0t  5F,03FF, 

096F,uC£F,J3=F,39JH,OF9H,J3FH,08CH,DlSF,J3FH,je7F,G7jH,02FF, 
C82F,0FeF,03FH,CFDH,C6AH,03EH,0F5H,a4  5H,0  3EH,0£CF  ,076H,03EF  ) 

DECLARE  (E  ,V,C,V1  ,01 ) (3)  ADDRESS  , 

(LCDKI,  WAXI)  BYTE, 

LCGK  (3)  BYTE  IMTIAL  ( 249,0,  195), 

MAX  (3)  BYTE  INITIAL  (249,0,195), 

ENTA  AOCRESSf  ENT  BASED  ENTA  BYTE, 

vala  address,  val  based  vala  byte, 
diffa  address,  ciff  based  DI'^FA  byte, 

VALIA  ADDRESS,  VALl  BASED  VALIA  BYTE, 

DiFFlA  ADDRESS,  DI'^Fl  BASED  DIFFIA-BYTE; 


/* 

INPLT  CCNSISTS  CF  A BASED  VARIABLE,  CLTPUT  WILL  BE 
IN  GLCBAL  VAPIABLES  T,  Tl,  T2 , AND  Z,  Zl,  Z2 


E(C)  = •TEMPA-'AN; 

V(J>  = .VALA tan; 

0(0)  = .DIFFA"^AN; 

£(2)  = .'•E^PCOS; 

V(2)  = .VALCCS; 

0(2)  = .DIFFCGS; 

ENTA  = F ( I ) ; 

VALA  = V(  I ) ; 

CIFFA  = 0(1); 

VAL lA  = VI  (!)  ; 

0 IFF  lA  = OKI); 

LCCKI  = LOCK(  I ); 

MAXI  = MAX  ( I ) ; 

ENTRY  = X; 

ENTRYl  = X (1  ) ; 

ENTRY2  = X(2)  ; 

IF  (LCCKI  = MAXI)  THEN 
LCCkI  = 0" 

IC  = CCMPARE ( .^NTRY, ENTA ♦LOCK  I ) ; 
IF  (10  = 1 ) THEN 
GC  TO  XITI  ; 
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iJ 


^ V— 


/■* 

REAC  UPWARDS  IN  THE  TABLE 


IF  ( IC  > 1 ) Tt-EN  DO ; 

LPl : IF  ( LCCKI  = MAXI ) THEN 

GC  TC  XI Tl; 

LCCKl=LC^Kl+3* 

ID  = CCMPAP‘E(  .fnTRY,EN"‘A  + LOQKI)  ; 
IF  (ID  = 1 ) then 
GC  TC  XITl; 

IF  (ID  > 1)  THEN 
GC  TC  LPl; 

LCCKI=LCCKI -3; 

GC  TO  XIT2; 

ENC; 

/ ^ 

READ  CCWNWAROS  IN  THE  TABLE 
*/ 


LP2:  IF  (LCCKI  = 0)  THEN 
GC  TO  XITl; 

LCCKI=L0CKI-3; 

IC=CCMPARE(  .ENTRY, ENTA+LCOKI  ); 

IF  (ID  = 1 ) THEN 
GC  TO  XITl; 

IF  (ID  < 1)  THEN 
GC  TO  LP2 ; 

GC  TC  XIT2; 

XITl:  T = 7AL( LCCKI  ) ; 

Tl  = YAL(LGCKI-*-l  ) ; 

T2  = YAL( LCCKl+2) ; 

IF  (I  <>  1)  THEN 
GC  TC  RET; 

Z = VALK  LCOKI  ) ; 

Z1  = VALKLCOKI  + L ) ; 

Z2  = VA  Ll( LCCKI +2  ) ; 

GC  TO  RET; 

XI T2 : TEMP  = ENT (LOOKI  ) ; 

TEMPI  = ENT(LOnKI  + l)  ; 

TE«P2  = ENT (LOOKI +2  ) ; 

/ * 

CHANGE  THE  SIGN  OF  TEMP 
TEMP2  = TEMF2  XOR  80H; 

TEMP  = ENTRY  - ENT(LOOK) 

*/ 

CALL  ADC( .TEMP, .ENTRY,  .TEMP  ) ; 

/ « 

(ENTRY  - ENT(LCGK  ) )«D  IFF(LOCK) 

*/ 

CALL  MULT( .TEMP,0IFFA+L00KI  ,.T)  ; 
call  ACC( . T ,7ALA*LCCK  I,  .T  ) ; 

VAL(LCOK)  ♦ ENTRY  - ENT(LOOK)  v CIFF(lQOK) 
♦/ 

IF  (I  <>  1)  THEN 
GO  TC  RET; 

CALL  MULT  ( . TEMP , D I >=F  1 A + LOGK  I , .Z  ) ; 

CALL  AOC( .Z,VAL1A*L00K  I , ,Z  ) ; 

RET:  LCCK(I)  = LCCKI; 

RETURN; 


ENC  FUNCTION; 


CCSSIN:  PR0CFCURE(XA,AC,AS)  ; 

DECLARE  XA  ACCRESS,  X BA5EC  XA  SYTEf 
AC  ALIDRESS,  S BASED  AC  BYTE, 

AS  ADDRESS,  Y BASED  AS  BYTE, 

(I  ,TH  ,Thi  ,TH2 , T h N , THNl , THN2 ) EVJE, 

(MPI2,MPI 21,MPI 22)  BYTE  INITIAL  ( 0C9H  , CFh  ,0C1H ) 
DECLARE  CUT  LABEL; 

/ * 

THIS  RCUTINE  CO>'?UTES  BCTH  ^HE  COSINE  AND  THE  SINE 
FOR  THE  GIVEN  ANGLE  XA  IN  RADIANS.  THE  OUTPUT  VALUES 
ARE  STCREO  IN  THE  GLOBAL  VARIABLES  Z,  Zl,  AND  Z2  FCR 
CCSINE,  AND  T,  I , AND  T2  FCR  SINE 
*/ 

TH  = X ; 

THl  = XII); 

TH2  = XI 2)  ; 

DC  1=1  TC  a; 

T H N = T H ; 

THM  = THl; 

THN2  = TH2  ; 

/ * 

THETA  = THETA  - I PI/2 ) 

CALL  ACC  ( .TH, .MPI2,.TH)  ; 

/■^ 

thN  = theta  bar  and  TH  = thFTA  BAR  - (PI/2) 

■*  / 

IF  (KZE  AND  BOH)  <>  0)  GR  KZZ  = COOOH)  AND 

( ZE  = JDh) ) ) then 

GO  TC  DLT; 

END; 

RETURN; 


CUT  : 

TH2=ZE  AND  7FH; 

call  function  (2,.THN); 

THN  = T ; 

THNl  = Tl; 

THN2  = T2; 

/* 

THN  = COS  (TH) 

CALL  function  (2,.TH); 

TH  = T; 

THl  = fl; 

TH2  = T2; 

/♦ 

TH  = SIN  (TH)  = COS  (PI/2  - TH) 
*/ 

/< 

ANGLE  IN  CUADRANT  1 CR  3 

*/ 

IF  (II  = 1 ) OR  (I  = 3) ) then  do; 


z 

Z 1 

(S 

(3(1) 

« . 

THN)  ; 
THNl) ; 

12 

= 

(S  (2  ) 

: = 

THN2 ) ; 

T 

S 

( Y 

: s 

TH)  ; 

T 1 

s. 

( Y(  1 ) 

; s 

THl  ) ; 

T2 

= 

( Y(2  > 

• = 

TH2  ) ; 

IF 

( I 

= 3) 

THEN  DC; 

12  = (S (2)  :=  12  XOR  080H) ; 
T2  = ( Y(2)  :=  T2  XOR  080H) ; 
RETURN  ; 

END; 

RETURN; 

END; 
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ANGLE  IN  sJUAOAANT  2 CR  4 


z 

= (S 

: = Th) ; 

Z1 

= (S(  1) 

: = THI ) ; 

Z2 

= ( S(  2) 

:=  Th2  XQP  08CH) 

T 

= ( Y 

:=  ThM); 

T1 

= (Y( 1 ) 

:=  ThNI); 

T2 

= (Y(2) 

:=  THN2); 

IF 

(1=4) 

THEN  do; 

T2 

Z2 

END 


= (S (2  ) 
= (Y(2J 


:=  T2 
:=  Z2 


XCR 

XCR 


D8  DH  ) 
080H) 


RETURN  ; 
END  CCSSIN; 


ATAN:  PROCEDURE  (XA,AT); 

DECLARE  XA  ADDRESS,  X BASED  XA  BYTE, 
AT  ADDRESS,  TV  BASED  AT  BYTE; 

CALL  FUNCT ICN(C, .X) ; 

TV(0 ) = T; 

TV( 1 ) = T1  ; 

TV(2)  = T2  ; 

RETURN  ; 

END  ATAN; 


REAL:  PROCEDURE  (AD,FD; 

DECLARE  AC  ADDRESS, XI  BASED  AO  BYTE,  Z (AO)  BYTE, PL  BYTE 

EICEC:  PROCEDURE  (AY,FL); 

DECLARE  AY  ADDRESS,  Y BASED  AY  BYTE, 

( PL,FLAG, I ,L ,K,SHIFT, P , LAST  I , J ) BYTE, 

X (16)  BYTE,  (XX, YY)  ADDRESS; 

/« 

eiCEC  CONVERTS  YhE  BINARY  IN'I’ERNAL  REAL  NUNBER  TC  A 
CECIVAL  NUMBER,  WHICH  CAN  BE  PRINTEC  BY  THE  .YCNITGR 

/“ 

FL  IS  A flag  WHICH  INDICATES  THE  NUMBER  TD  BE 
CCNYER'^ED  IS  fl  = 0 REAL 

FL  = 1 ADDRESS  VARIABLE 
FL  = 2 BYTE  VARIABLE 

DC  1=0  TO  15; 

X( I ) =J; 

END; 

DC  1=0  TC  3S; 

Z(  I )=0; 

END; 

IF  Y=0  THEN 
RETURN; 

YY=SHL(COUBLE(Y ) , 8)  OR  OGUB LE ( Y ( 1 ) ) ; 

IF  <Y(2)  AND  8JH)OJ  THEN  DO; 

flag=i; 

K=V(2)  AND  07FH; 

END ; 

ELSE  DC; 

flag=d; 

K=Y( 2) ; 

END; 

L=k-6A; 
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IF  (X  >=  64)  THEN  DO; 

I=SHR ( L, 3) ; 

R = L-SHL(  1,3) ; 

R=3-R ; 

1=1+8 ; 

END; 

ELSE  DC; 

L=-L ; 

I=SHP ( L , 3) ; 

R=L-SHL ( 1,3) ; 

1 = 7-1; 

END ; 

IF  (I  >=  1)  THEN  CO; 

X( I )=HIGH( YY) ; 

X( I-l )=LCW (YY ) ; 

YY=SHL( OCUBLE (X(I-1)),8); 

YY=SHR ( YY, R) ; 

IF  (I  >=  2 ) then 

X(  1-2  ) = LOVs(  YY)  ; 

YY  = SHL( OCUBLE ( X (I  ) ) , 8)  OR  DQUBL E ( X ( I - 1 ) ) ; 
YY  = SHR(YY,P.)  ; 

X( I ) =HIGH( YY)  ; 

X( I-1)  = LCW(YY)  ; 

END; 

ELSE 

X(  I ) =SHR (X ( I ) , R ) ; 

IF  (I  >=  8)  then  CO; 

LASTI=I ; 

R = 0; 

K = 20  ; 

RECYCLE:  XX  = SH L ( D CUBLE ( R ) ,8  ) CP  X(I); 

YY  = XX/10  ; 

X( I )=LCW (YY) ; 

R=XX  MOD  10; 

IF  (I  = 6)  then  do  ; 

Z (K) =R+' 3* ; 

K=K+1  ; 

IF  (X{8)  = 0)  THEN 
GC  TO  FRACT; 

I F (X(LASTI  ) = 0)  THEN 
LASTI  = LASTI  - 1; 

R = 3; 

I =LASTI ; 

GC  TC  RECYCLE; 

END; 

I = I - l; 

GC  TC  RECYCLE; 

END; 

DECLARE  LEASTI  BYTE; 


FPACT:  IF  FL=C  THEN  DO; 

LEASTI =1-2; 

IF  LEASTI  >=  8 THEN 
RETURN; 

DO  1=0  TC  19; 

L = 0; 

CQ  K=LEASTI  to  7; 

YY  = D0UBLE  (X(K)  ) ’XI 0+ DOUBLE!  L)  ; 
X(K)  = L0V,(YY)  ; 

L=HIGH( YY)  ; 

END; 

Z( 19-1 )=L+  'O'  ; 

END; 

END  ; 

IF  FLAG=1  then 
Z( 39) =offh; 
return  ; 

ENC  EICEC; 
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PPINTMJM:  FPGCEOURG; 

CECLJRE  (I.K)  BYTE; 

CECL^RE  (DIGIT,  EN^RV)  LABEL; 

PRINTS  A real  number  IN  THE  FQk'^  ( - ) XX  XX  X . X X X > X XX 
WI'^H  leading  zeroes  SUPPRESSED 
*/ 

DC  1=1  TC  5; 

IE  (I  = 5)  AND  (Z(20)  = C)  THEN  DO; 

IF  (Z(39)  = OFRH)  THEN 

CALL  PRINTCHAR  ('-•); 

E L SE 

CALL  PRINTCHAR ( ' • ) ; 

GC  TG  entry; 

END; 

IF  Z(25-n  <>  0 THEN  DO; 

IF  (Z(39»  = C^FH)  THEN 
CALL  PRINTCHAR 
ELSE 

call  PR INTCHAR ( ' • ) ; 

GG  TO  DIGIT; 

END; 

CALL  PRINTCHAR ( • • ) ; 

END; 

GC  "^0  ENTRY; 

DIGIT; 

DC  K=I  TC  5 ; 

CALL  PRINTCHAR(Z(25-K) ) ; 

END; 

ENTRY: 

CALL  PR  IMTCHAF 
DC  K = I TC  7; 

CALL  PRINTCHAR  (Z(20-KM  ; 

END; 

return; 

END  FSINTNUM; 

call  BICEC ( .XI  ,FL)  ; 
call  crintnum; 

RETURN; 

END  peal; 

I 

t 


i 

I 


/« 

INIT!  iLIZATICN  QP  CMEGA  STATION  CIRECTICN  COSINE  VALJ'IS 
WHICH  REPRESENTS  A UNIT  VECTOR  FROM  EARTH'S  CENTER  TO 
THE  STATION  IN  GEOCENTRIC  COORDINATES 
* / 


declare 

STATION 

A 

SA  1 

(3) 

BYTE 

INI TI AL 

( OEAH, 

05FH, 

OAOH  ) , 

C .9  155  1829 

SA2 

( 3 ) 

BYTF 

INITIAL 

( OC8H, 

08FH, 

03FH)  , 

0. 2917233A 

*/ 

SA3 

(3) 

BYTE 

INI T lAL 

( OBBH, 

077H, 

J3DH  ) , 

/* 

0.  39153733 

/<'  STATION  B 

' 

SBl 

(3) 

BYTE 

INI T lAL 

( OFBH, 

072H, 

OAOH)  , 

/* 

C.982210AI 

*/ 

SB2 

(3  ) 

BYTE 

INITIAL 

( 0F8H, 

02EH, 

OAOH  ) , 

C.  98  1175  17 

$53 

(3  J 

EYTE 

INI T !AL 

( 0A9H, 

D DDH  , 

OBEH  ) , 

-C.  Ic588382 

*/ 

1^  STATION  C 

*/ 

SCI 

(3) 

BYTE 

INI TIAL 

( 0B9H, 

OC5H, 

03FH  ) , 

/* 

0. 3628328  1 

*/ 

SC2 

(3) 

BYTE 

INIT  lAL 

( OCCH, 

JEBh  , 

OCOH  ) , 

/* 

~0«  86296869 

*/ 

SC3 

(3) 

BYTE 

INI T lAL 

( 0 SAh  , 

0 G7H , 

OBFH  ) , 

/* 

-0.35162108 

*/ 

/*  STATION  D 

SCI 

(3) 

BYTE 

initial 

(OBBH, 

OBOH, 

OAOH  ) , 

C . 72  1Ah222 

$C2 

(3) 

BYTE 

INI T lAL 

( JCDH, 

099H, 

OBOH  ) , 

-0.  1C039077 

-*/ 

3D3 

(3) 

BYTE 

initial 

( 0 AFH  , 

066  H , 

OCOH  ) , 

-0.68515898 

=»/ 

STATION  E 

■*/ 

SEI 

(3  ) 

BYTE 

If^IT  lAL 

(066H, 

032h, 

OBFH)  , 

/* 

-C . 25535299 

*/ 

SE2 

(31 

BYTE 

initial 

( OS3H, 

03AH, 

OAOH  ) , 

/T 

C . 532  148  75 

SE3 

(3) 

BYTE 

INITIAL 

( OCAH, 

C A B H » 

OAOH  ) , 

/s: 

0.  76823587 

/*  STATION  F 

*/ 

SPl 

(3) 

RYT  = 

INITIAL 

(OAEH, 

323H, 

JC OH  ) , 

/* 

-o.es:229Ai 

SF2 

(3  ) 

BYTE 

INI  lAL 

( 09DH, 

078H, 

03FH  ) , 

/•* 

0.30756230 

•/ 

SF3 

(3  ) 

BYTE 

INIT  lAL 

( 0 aah. 

05AH, 

CC  0 H ) , 

-C.  665352C7 

* / 

/<■  STAT 

ION  G 

*/ 

SGI 

(3) 

BYTE 

initial 

INITIAL 

( OBCh, 

OECH, 

03EH  ) , 

0 . 1 8A A9  5 6 5 

SG2 

(3) 

BYTE 

( 0 EFH , 

009H, 

03FH  ) , 

/* 

C.  466871  It 

*/ 

SG3 

(3) 

BYTE 

INI''’  lAL 

( J DCH , 

06  7 H t 

OC  OH  ) , 

/ ■* 

- 0 . £6 A3b5  7 0 

* / 

/•*  STATION  ri 

*/ 

SHI 

(3) 

BYTE 

IN! ^!AL 

( 090H, 

0C2H, 

OAOH  ) , 

/« 

0.565A7261 

« / 

SH2 

(3  ) 

BYTE 

initial 

( D86H, 

02BH, 

OCOH  ) , 

-0. 52-+C9936 

*/ 

SH3 

(3) 

EYTE 

IM  T lAL 

( J A3H, 

J 07H, 

OAOH  ) ; 

/•* 

0.63683639 

/* 

VELOCITY  ANC  NAVIGATION  PROCESSING  DEFINITIONS 
DECLARE 

NAVIGATION  CYCLE  - l.J  SEC  «/ 

DTNAv  (i)  BYTE  INITIAL  (C8CH,  OOOH,  OAIH), 

/*  ANGULAR  RCTATICNS  ABOUT  THE  SYSTEM  AXIS  =»/ 
D5LT2  (2)  BYTE, 

DELT2  (3)  BYTE, 

/’O  earths  ELLIPTICITY  CONSTANT  - 0.003352S  */ 
EEC  (2)  BYTE  INITIAL  IJCBH,  J3CH,  J38H), 

/*  OMEGA  AIRCRAFT  LATITUDE  ANC  LONGITUDE 
CLATAC(3)  byte, 

CLCNAC(3)  BYTE, 
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/* 

INITIAL  LCCATICN  MONTEREY,  CALIFORNIA 
LATITUDE  3bDEG  35  MIN  N - 0.6384^9618  RADIANS 
LCNGITUCE  121DEG  51  MIN  W - 2.126683694  RADIANS 
NOTE:  INSERT  N LAT.  POSITIVE 
INSERT  S LAT.  NEGATIVE 
INSERT  E LONG.  POSITIVE 
INSERT  W LONG.  360UEG  - INITIAL  LONG. 

*/ 

CLATIN(3)  BYTE  INITIAL  (DA3H,  374H,  D43h), 

/* 

INSERT  36CDEG  - 1210EG  51MIN  W 

INSERT  2380EG  09  MIN  - 4.  156501614  RADIANS 

=»/ 

CL0MN(3)  BYTE  INITIAL  (085H,  002I-,  043E), 

/«  EARTHS  MEAN  cQUA'^DRIAL  RADIUS  - 2392574  1.47  FT  «/ 
EME^?  (3)  BYTE  INITIAL  (C9FH,  0A6H,  059I-), 

WIND  OIREC^ICN  */ 

WD  (3)  BYTE, 

/*  AIRCRAFT  HEADING  «/ 

ACf-CG  (3)  BYTE, 

/■>  SYSTEM  HEADING  ANGLE  -/ 

51-CGA  (2)  BYTE, 

/*  OLD  MODE,  NEW  MODE,  NAVIGATION  MODE 
(CLCN,  fEWM,  NAVMCCE)  BYTE, 

/«  DVC3  = (VC3  * DTNAV)  / EMER  */ 

CVC3  (2)  BYTE, 

/»  0VC2  = (VC2  =»  DTNAV)  /EMER 
CVC2  (3)  BYTE, 

ELEMENTS  X5  AND  X6  OF  STATE  VECTOR 
SIGVC2  (3)  BYTE  INITIAL  (OOOH,  OOOH,  C4CH), 

SIGV03  (3)  BYTE  I M ""I  AL  (OOOH,  OOOH,  04GH), 

/*  CONVERSION  FACTOR  RADIANS  TO  DEGREES  =>/ 

RADTCDEG  (3)  BYTE  INITIAL  (08EH,  OFAH,  03BH), 

/*  TEMP.  STORAGE  AFTER  CONVERSION  RAD  TO  DEG  t/ 


RESULT 

(3)  BYTE, 

VAN 

(3) 

BYTE, 

/* 

AI RDAT A 

VELOCITY 

COMPCNFNT 

NORTH*  / 

VAE 

( 3 ) 

BYTE, 

/’!■ 

AI  PDATA 

velocity 

COMPCNEN'T 

EAST  */ 

VDN 

( 3 ) 

BYTE, 

/=!■ 

DOPPLER 

VELOCITY 

COMPONENT 

NORTH*/ 

VOE 

(3) 

BYTE, 

/* 

DCPPLER 

VELCC  ITY 

COM  PON  ENT 

EAST  */ 

V IN 

( 3 ) 

byte, 

/*IN6R  TI AL 

vplocity 

COMPCNENT 

NORTH*/ 

VIE 

(3) 

BYTE, 

/^INERTIAL 

VELOCITY 

COMPONENT 

EAST  */ 

VC  2 

( 2) 

BYTE, 

CORRECTED  VELCCITY  ALONG  R2 

AXIS*/ 

VC  3 

(3  ) 

BYTE, 

/T 

CORRECTED  VELOCITY  ALONG  R3 

AXIS*/ 

VCA 

(2) 

BYTE, 

DOPPLER 

VELCCITY 

ALONG  FEACIMG  */ 

yrr 

(3) 

37TE, 

/-» 

DOPPLER 

VELCCI TY 

ACROSS  HEA 

DING  */ 

V ’A3 

( 3 ) 

BVTE, 

/<■ 

TRUE  AIR  SPEED  V 

ELOC  ITY 

*/ 

4 n 

( 3) 

BYTE, 

/♦ 

WIND  VE 

lOC ity 

*/ 

/ 

* ITEMS  OF  3 

BY 

3 POSITION  MATRIX 

=»■/ 

( 3 ) 

BYTE, 

1 • ) 

BYTE, 

( ’ ) 

BYTE, 

« ’ ) 

BYTE, 

« ) 

BY^’E  , 

1 i 

Y T E , 

1 

yTE  , 
’ c , 

J 
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INIT lAL IZE$R:  PROCEDURE; 

/* 

INITIALIZATION  OF  POSITION  MATRIX  R 
«/ 

/* 

Rll  = SIN(LAT),  R31  = COS(LAT) 

CALL  COSSIN  (.CLATIN,  .R31t  .Rll); 
/* 

R22  = SIN(LONG),  R23  = CCS(LONG) 

=>/ 

CALL  CCSSIN  (.CLONIN,  .R23,  .R22); 
/* 

R 12  = COS(  LAT  ) ’i'  CCS  (LONG) 

CALL  MLLT  (.R31,  .R23,  .R12); 

/>» 

R13  = COS(LAT)  * SIN(LONG) 

CALL  MULT  <.R31,  .R22,  .R13); 

/< 

R21  INITIALIZE  TO  ZERO 

R21  (C)  = COOH; 

R21  (1)  = OJJh; 

R21  (2)  = COOH; 

CHANGE  THE  SIGN  OF  Rll 
Rll  (2)  = Rll  (2)  XOR  080H; 

R23  = -SIN(LAT)  * SIN(LONG) 

CALL  MULT  (.Rll,  .R22,  .R33); 

/* 

R22  = -SIN(LAT)  ^ COS(LONG) 

CALL  MULT  (.Rll,  .R23,  .R32); 

CHANGE  THE  SIGN  OF  Rll  AND  P22 

Rll  (2)  = P IK  2)  XOR  080H; 

P22  (2)  = R22(2)  XOR  080H; 

RETURN  ; 

END  initializesr; 


NEk^PCS:  PROCEDURE; 

/* 

UPCATE  THE  PCSITION  MATRIX  R AND  CALCULATE  NEW 
LATITUDE,  LONGITUDE,  AND  SYSTEM  HEADING  ANGLE 
*/ 

DECLARE  (A,  Al,  A2,  A3,  B,  Bl,  62,  63,  Cl,  C2,  C3)  (3) 
(SUMl,  SUM2,  SUM3,  02SQR,  D3SCR)  (3)  BYTE; 

CALL  MULT  (.DELT2,  .R31,  .A); 

CALL  *<ULT  (.DELT3,  .R21,  .B); 

CALL  SUB  ( .8,  .A,  .Cl); 


BYTE, 
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C4LL  NULT  <.DELT2,  .932,  .A); 

CALL  NULT  (.0ELT3,  .922,  .B); 

CALL  SUB  ( .6 , .A,  .C2 ) ; 

CALL  ^ULT  (.DELT2,  .933,  .A); 

CALL  yULT  (.DELT3,  .923,  .8); 

CALL  SUB  ( .e,  .A,  .C3  ) ; 

CALL  ADD  ( .Cl,  .911,  .SUMl  ) ; 

CALL  ACD  ( .C2,  .912,  .SUM2)  ; 

CALL  ADO  (.C3,  .913,  . SUM3 ) ; 

/« 

SLBTRAC^ING  ONE  FROM  THE  EXPONENT  VALUE  WILL 
CAUSE  THE  MANTISSA  TC  APPEAR  TO  BE  CIVIOEO  BY  2 
*/ 

Cl  (2)  = Cl  (2)  - 00 1H; 

C2  (2)  = C2  (2 ) - JOIH; 

C3  (2)  = C3  (2)  - OOIH; 

CALL  ADD  ( .Cl  , .911,  .Al)  ; 

CALL  ACD  ( .C2,  .912,  .A2)  ; 

CALL  ACC  ( .C3,  .913,  .A3  J ; 

CALL  yULT  {.DELT2,  .CELT2,  .D2SQR>; 

CALL  yULT  (.DELT3,  .CELT3,  .D3SwR); 

CALL  ADC  {.D2SCR,  .D3SQR,  .B); 

E (2)  = B (2 ) - OOIH ; 

CALL  MULT  (.3,  .911,  .81); 

CALL  yULT  ( .8 , .912,  .82  ) ; 

CALL  yULT  ( .8 , .913,  . 33  ) ; 

CALL  SUB  ( .SUMl,  .81  , .911 ) ; 

CALL  SLB  (.5Uy2,  .82,  .912); 

CALL  SUB  (.SUM3,  .83,  .913); 

CALL  yULT  (.Al,  .0ELT3,  .A); 

CALL  yULT  (.Al,  .0ELT2,  .8); 

CALL  SUB  ( .921  , .A,  .921  ) ; 

CALL  ADD  (.93  1 , .3  , .331  ) ; 

CALL  NULT  (.A2,  .DELT3,  .A); 

CALL  yULT  (.A2,  .0ELT2,  .8); 

CALL  SUB  ( .922  , .A  , .922  ) ; 

CALL  ADO  ( .932  , .8,  .932) ; 

CALL  MLLT  (.A3,  .DELT3,  .A); 

CALL  yULT  (.A3,  .DELT2,  .8); 

CALL  SU3  ( .923,  .A,  .923)  ; 

CALL  ACD  ( .933  , .8,  .933 ) ; 

CALL  CIV  ( .921  , .931,  .A)  ; 

CALL  DIV  ( .913  , .912  , .8)  ; 

CALL  ATAN  ( .A,  .SHOGA  ) ; 

CALL  ATAN  ( .8,  .0L3NAC)  ; 

CALL  CCSSIN  (.SHOGA,  .3,  .A); 

CALL  yULT  ( .8,  .911,  .A)  ; 

CALL  CIV  (.A,  .931,  .8); 

CALL  ATAN  (.8,  .OLATAC); 

FETUPy  ; 

END  yEWFCS; 


VELFPGC:  PROCEDURE; 

/* 

CCyPUTE  NC9TH,  SCUTH,  EAST,  AND  WEST  VELOCITIES 
ANC  CCyPLTE  VELOCITIES  ALONG  THE  SYSTEM  AXIS 
*/ 


I 

$ 
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CECLiRE  (A,  Al,  A2,  A3)  (3)  BYTE, 

(6,  61,  82,  B3)  (3)  BYTE, 

(C,  Cl,  C3,  D,  Cl)  (3)  BYTE, 

(CELVC2,  CELVC3)  (3)  BYTE, 

(VELE,  VEIN)  (3)  BYTE; 

/* 

E = CCS(AIRCRAFT  HEACING),  A = S!N(A1RCRAFT  HEADING) 
CALL  CCSSIN  (.AChOG,  .B,  .A); 

/* 

C = CCS(WIND  CIRECTICN),  C = SIN(V,IND  DIRECTION) 

CALL  CCSSIN  ( ,RD,  .D,  .C) ; 

/* 

A1  = SIN(AChOG)  * VDC 
CALL  NULT  (.A,  .VDC,  .Al); 

/» 

El  = CCS(AChDG)  - VOA 
*/ 

CALL  VULT  (.B,  .VDA,  ,Bl)  ; 

/# 

A2  = SINIACHOG ) + VCA  • 

CALL  VULT  (.A,  ,VCA,  .A2); 

/=» 

E2  = CCS(ACHDG)  * VDC 
*/ 

CALL  MULT  ( .B , .VDC  , .62  ) ; 

/=» 

VCN  = CGS(ACHDG)  ? VDA  - SIN(ACHOG)  * VDC 
’»/ 

CALL  sue  ( .81  , .Al , .VDN)  ; 

VCE  = COS(ACHDG)  VCC  > SIN(ACHDG)  =«■  VDA 
* / 

CALL  ACC  ( .E2,  .A2,  .VDE ) ; 

E3  = CCS (ACHDG ) k VTAS 
CALL  RULT  (.8,  .VTAS,  .33); 

/* 

A-  = SIN(ACHDG)  * VTAS 
*/ 

CALL  RULT  (.A,  .VTAS,  .A3); 

/* 

Cl  = CCSCrtC)  # vw 
CALL  RULT  ( .D,  .V^,  .Cl)  ; 

/* 

Cl  = SIMWC)  VW 
♦/ 

CALL  RULT  ( .C,  .VW,  .Cl)  *, 

/* 

VAN  = CCS(ACHDG)  * VTAS  + COS(WD)  * VW 
CALL  ADD  ( .83  , .Dl , .VAN  ) ; 
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VaE  = SIN(ACHDG)  - VTAS  + STJCV^O)  ^ VW 
CALL  ACC  (.A3,  .Cl,  .VAE); 


d = CCS(ShCGA),  A = SIN'(SHCGA) 

CALL  CCSSIN  (.SHDGA,  .6,  .A); 

CC  CASE  NAVMQDE; 

/=>  CASE  0 - INERTIAL  CCMPONENTS  =*■/ 
CG  * 

VELN(O)  = VIN(O)  ; 

VELN(l)  = VIN(  1)  ; 

VELN(2)  = VIN(2)  ; 

VELE (0)  = VIE(O)  ; 

VELE(l)  = VIE(l); 

VELE(2)  = VIE(2)  ; 

END; 

/*  CASE  1 - DOPPLER  COMPONENTS  */ 
DC; 

VELN(O)  = VDN(C)  ; 

VELN  ( 1 » = VDrj(  1 ) ; 

VELN(2)  = VDN(2 I ; 

VELE(O)  = VDE(C) ; 

VELEd  ) = VDE(  1 ) ; 

VELE (2)  = VDE (2)  ; 

END; 

CASE  2 - AIR  DATA  CCMFONENTS  */ 
CO  * 

VELNO)  = VAN(  3)  ; 

VELN(  1)  = VAN( 1)  ; 

VELN  (2  » = VAN( 2 ) ; 

VELE ( 3)  = VAE ( 0) ; 

VELE(  1 ) = VAE ( 1 ) ; 

VELE  (2)  = VAE ( 2)  ; 

END; 


ENC  ; 

/« 

ei  = 

VELE 

’»  CnS(  SHDGA) 

*/ 

CALL 

MLLT 

(.VELE,  .3, 

.31 ) ; 

/* 

Al  = 

VELN 

=)>  SIM(ShDGA) 

CALL 

MOLT 

(.VELN,  .A, 

. Al ) ; 

E2  = 

VELN 

COS(SHCGA) 

*/ 

CALL 

MULT 

(.VELN,  .B, 

.B2)  ; 

/« 

A2  = 
*/ 

VELE 

* SIN(SHCGA) 

CALL 

MULT 

(.VELE,  .A, 

.A2) ; 

/* 

A3  = 
*/ 

VELE 

COS  (SHDGA) 

+ VELN 

CALL 

ACC  ( 

.Bl,  .Al,  .A3); 

/♦ 

82  = 
*/ 

VELN 

* C05( SHDGA) 

- VELE 

CALL 

SUB  ( 

.62,  .A2,  .63); 
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/* 

Cf-ECK  IF  UPGRACE  OR  COwNGRADE  OF  NAV.  MODE 
*/ 

IF  QLCM  < NEWV  THEN 
CC  * 

CLCM  = NEWM; 

/« 

CELTA  VC2  = VC2  - ( VELE=»COS  (SHDG A ) + VELN=»S  I\(  SHDGA  ) ) 
*/ 

CALL  sue  (.VC2,  .A3,  .OELVC2); 

/» 

CELTA  VC3  = VC3  - ( V ELN*COS ( SHDGA ) - VE LE* S IN ( SHDGA ) ) 
*/ 

CALL  SUB  (.VC3,  .03,  .DELVC3): 

ENC; 

ELSE 

DC; 

IF  CLDM  > NEWM  THEN 
CQ; 

/* 

SET  CELTA  7C2  AND  DELTA  7C3  TC  ZERO 
*/ 

0ELVC2  (C),  0ELVC3  (0)  = OOOH ; 

DELVC2  (1),  DELVC3  (1)  = JODI-; 

CEL7C2  (2),  DELVC3  (2)  = 0401- ; 

END; 

CLO  = NEWM; 

call  sue  (.CELVC2,  .SIGVC2,  .D6LVC2); 

CALL  SU3  (.CELVC3,  .SIGVC3,  .0ELVC3); 

ENC  ; 

/* 

SET  SIGMA  VC  2 AND  SIGMA  VC  3 TO  ZERC 

SIGVC2  (0»,  5IGVC3  (C)  = OOOH; 

S1GVC2  (1),  SIGVC3  (1)  = OOOH; 

SIGVC2  (2J  , SIGVC3  (2)  = 040H; 

CALL  ACD  (.A3,  .DELVC2,  .VC2); 

CALL  ACD  (.03,  .DELVC3,  .VC3 ) ; 

RETURN; 

ENC  VcLFRCC; 


NAVFPCC:  PROCEDURE; 

/# 

NAVIGATION  PROCESSING  FOR  POSITION  COMPUTATIONS 
*/ 

DECLARE  (RllSCR,  R2IS0R,  R31S0R,  R2131)  (3)  BYTE, 
(CIFFl,  0IFF2,  W,  X,  Y,  Z)  (3)  BYTE, 
(TEMPI,  TEMP2,  TEMPO)  (3)  BYTE; 

DECLARE  ZERO  (3)  BYTE  INITIAL  (OOCH,  OCCH,  040H), 
CNE  (3)  BYTE  INITIAL  (080H,  OOOH,  041H); 

/* 

RllSCR  = Rll  Rll 
*/ 

CALL  MLLT  (.Rll,  .Rll,  .RllSQR); 

I* 

521SCR  = R21  * R2I 

CALL  MULT  (.R21,  .R21,  .R21SQR); 

/* 

R - 1S£P  = R 31  * R3 I 
♦ / 

CALL  MULT  (.R31,  .R31,  .R31SUK); 
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/* 

R212  1 = R21  * R31 

CALL  l-ULT  (.R21,  .R31,  .R2131); 

/« 

ACCING  CNE  TO  THE  EXPONENT  VALUE  WILL  CAUSE 
THE  RAMISSA  TC  APPEAR  TO  BE  MUL'^IPLIEO  8Y  2 
*/ 

R21SCR(2>  = R31SQR  (2)  + OOIH; 

R21SCR(2)  = R21SQR  (2)  + )31H; 

R2131  (2J  = R2131  (2)  + OOIH; 

/* 

CIFFl  = 2 « (R31  * R31)  - Ril  * Rll 
*/ 

CALL  SUB  I.R31SUR,  .RUSQRt  .DIFFl); 

DIFF2  = 2 * (R21  * R21)  - Rll  ^ Rll 
CALL  SUB  (.R21SQR,  .R115CR,  .DIFF2); 

/« 

TEMPI  = DIFFl  « EEC 

TEMP2  = DIFF2  * EEC 

TEMF2  = R2131  * EEC 

CALL  MULT  (.DIFFl,  .EEC,  .TEMPI); 

CALL  MULT  (.CIFF2,  .EEC,  .TEMP2); 

CALL  MULT  (.R2131,  .EEC,  .TEMP3); 

/♦ 

W = 1 + EEC>»=(  2«R31*R3l  - Rll^Pll) 

X = 1 + EEC^(  2*R21>i‘9  21  - Rll-^Rll) 

call  ado  (.TEMPI,  .ONE,  .W); 

CALL  ACC  (.TEMP2,  .ONE,  .X); 

/* 

TEMPI  = OVC3  ’>  ( 1 + EEC*(  2*R31’>'R31  - R11*R11)) 

TEMF2  = DVC2  * ( l + EEC’i' ( 2i‘R21  + R21  - Rll^Rll)) 

Y = DVC3  * (EEC*(2’*R21*R31  ) ) 

Z = CVC2  ’S'  (EEC’S<(2’*R21*R31  ) ) 

*/ 

CALL  MULT  (.W,  .DVC3,  .TEMPI); 

CALL  MULT  (.X,  .DVC2,  .TEMP2  ) ; 

CALL  MULT  (.TEMP3,  .CVC3,  .Y); 

CALL  MULT  (.TEMP3,  .CVC2,  .2 ) ; 

/ ^ 

CHANGE  THE  SIGN  OF  TEMPI 

TEMPI  = -CVC3’*  (l-*-EEC*(2=!«P31<‘R31  - R11*R11)) 
TEMPI  (2)  = TEMPI  (2)  XQR  D80H; 

/< 

CELT2  = -CVC3<'(1+EEC*(2*R31*R31-R11*R11)  ) 

- CVC2*(EEC^(2*R21’S'R3D) 

*/ 

CALL  SUB  (.TEMPI,  .Z,  .CELT2); 

/♦ 

CELTS  = CVC2’«‘(1  + EEC*(2-S'R21*R21-R11*R11)  ) + 

CVC3«(EEC<‘(2*R21'S'R31)  ) 

*/ 

CALL  ADD  (.TEMP2,  .Y,  .OELT3  ) ; 

RETURN  ; 

END  NAVPPCC; 
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CMEG/s:  FPCCEDURE; 

DECL/SRE  (I,J,K)  BYTE, 

(TMFCNE,  TMPTW3}  (3)  BYTE, 

(SUM0ELT2,  SUMDELT2)  (3)  BYTE; 

DECLARE  FI  (3)  BYTE  INITIAL  (0C9H,  OOFH,  0A2H ) ; 

C/5LL  IMTIALIZ£$R; 

CC  K = 1 TC  6J; 

CC  J = 1 TG  a; 

SUMCELT2(0),  SUMDELT3(0)  = OCCH; 

SUMDELT2(1),  SUf'DELT3(l)  = 300I-; 

SUMDELT2(2),  SUf^DELT3(2)  = OACH; 

CO  I = 1 TO  15; 

CALL  VELPRQC; 

/* 

CVC3  = (VC3  DTNAV)/EMER 
CVC2  = (VC2  ^ DTNAV)/EM£,'R 
*/ 

CALL  MULT  (.VC3,  .DTNAV,  .TMPCNE); 

CALL  CIV  (.TMPQNE,  .EMER,  .CVC3); 

CALL  MULT  (.VC2,  .CTNAV,  .TMFTWO); 
call  DIV  (.TMPTWO,  .EMER,  .CVC2); 

CALL  NAVPROC; 

CALL  ADD  (.SUMDELT2,  .DELT2,  .SUMDELT2); 
CALL  ADD  (.SUMDELT3,  .OELT3,  .SUMDELT3I; 
END; 

DELT2(0)  = SUMDELT2(0) ; 

DELT2U)  = SUMCELT2(1); 

DELT2(2)  = SUMCELT2(2); 

CELT3(0)  = SUMDELT3(0) ; 

CELT3(1)  = SUMCELT3(1) ; 

CELT5(2)  = SUNDELT3(2) ; 

CALL  NEWPOS; 

CALL  PRINT  QVEGA  LGN  C- I TUDE-R  A C I A N S J ' ) ; 

CALL  REAL  ( .GLCNAC , 0)  ; 

CALL  OIV  (.3L0NAC,  .RAQ-^OCEG,  .RESULT); 

CALL  PRINT  (.'  OMEGA  LONG  I TUDE-0 E GR E ES f * ) ; 

CALL  REAL  ( .RESULT,  C) ; 

END; 

END  ; 

RETURN  ; 

ENC  CMEGA; 


INITIAL  CONDITIONS  - NO  WIND  SOLU'!' ICN  FLYING  CUE  EAST 
AT  3C0  KMCTS  FROM  MONTEREY,  CALIF.  AIRPORT  ♦/ 

GLDM  = C; 

NEW*  = 2 ; 

NAVMCCE  = 2; 

/♦  WINC  CIRECTION  000  DEG  = O.OOOOOORAD 
WOO)  = OCOh; 
wc(  1 ) = OCOh; 

WC(2)  = COOh; 

/*  AIRCRAFT  FEACING  090  DEG  = 1.570766  RAO  */ 

ACHCG(C)  = 0C9h; 

ACHCGI  1 ) = OOFH  ; 

ACHCG(2)  = OAIH; 

/*  SYSTEM  HEADING  ANGLE  000  DEG  = O.COCOOO  RAD  ♦/ 

SHDGA(C  ) = OOCH  ; 

SHOGA(  1 ) = OOCH  ; 

SHCGA( 2 ) = OOOH  ; 

VAN(C),  VAE(O),  VDN(O),  VDE(O),  VIN(O),  VIE(O)  = COCH; 

VAN(l),  VAE(l),  VCN(l),  VDE ( 1 ) , VIN(l),  VIE<1)  = COCH; 

VAN(2),  VAE12),  VCM2),  VDE(2),  VIN(2),  VIE(2)  COCH; 
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VC3(C),  VCA(C),  VCC(O),  VW(0)  = OOOH; 
VC3(i)t  VCAdJ,  VCC(l),  VW(1»  = OOOH; 
VC3(2),  VCA(2»  , VDC(2),  VW(2)  = OJJH; 

/* 

TRLE  AIR  SPEED  = 30 J KNCTS 
300  KNOTS  = 5G6.3A29575  FT/SEC 
*/ 

VTAS(C)  = OFDF; 

VTAS ( 1 ) = 02BF  ; 

VTAS(2)  = 049F; 

/* 

SET  CCRRECTEC  VELCCITY  = 333  KNOTS 
300  KNOTS  = 506.3429575  FT/SEC 
*/ 

VC  2(C)  = OFOH; 

VC2 ( 1 ) = 02BH  ; 

VC2(2)  = 0A9H; 

Z’*  ^AIN  PROGRAM  -^/ 

CALL  ONEGA; 

HALT  ; 

EOF 


t 
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